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© Method and apparatus for controlling maneuvers of a vehicle, and vehicle comprising such 
apparatus. 



© Maneuvers of a vehicle, such as a car, are planned by propagating cost waves in a configuration space 
using a search strategy referred to as budding. 
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Method and apparatus for controlling maneuvers of a vehicle, and vehicle comprising such apparatus. 
BACKGROUND OF THE INVENTION 



1 . Field of the Invention 

5 

The invention relates to controlling maneuvers of a robotic vehicle and in particular to parking a car. 
Maneuvering a vehicle in this way is a particular example of planning an optimal path for an object to follow 
from a given start point to a nearest one of a set of goals, taking into account constraints and obstacles. 
Maneuvering typically takes place on a scale that does not permit to neglect the dimensions of the vehicle. 



2. Related Art 

One of the most important outstanding problems in robotics is that of path planning with obstacle 

is avoidance. In a typical task, the robot has to move from a start location to a goal location. Obstacles should 
be avoided along the way, and the movement as a whole should be as efficient as reasonably possible. The 
planning of the path sould be as rapid as possible. The problem of providing such a "path" for a robot, for 
instance by giving a series of set points, is called the path planning problem. 

There are a number of existing robots. Typically they are controlled using a programming language. 

20 One commonly used language is Val II, described in Unimation, Inc., "Programming Manual: User's Guide 
to Val II: Version 2.0 398AG1", December 1986. Vali II can be used to control products such as Unimation's 
Puma Robots and Adept Robots. Using Val II, a user can specify the movement of a robot, from a current 
point to a desired point, using the command MOVE POINT () on page 4-20 of the reference. Points are 
usually generated in joint coordinates. It is therefore sufficient for a path planning method to generate a 

25 series of set points to be inserted in the appropriate Val II command. The technology is in place for the 
robot to follow a path once the set points are generated. 

Typical industrial robots use manually generated set points. Such manually generated set points are 
adequate for performing a simple repetitive task such as automated assembly in an environment which 
does not change from one task to the next. Manually generated set points are not practical and paths 

30 followed are often not efficient for dynamic situations, or for situations with large numbers of obstacles, or 
for obstacles with complex shapes. Therefore there is a need for a method to generate set points 
automatically. 

One known method automatically generates a set of points along an optimal path. The set of points 
allows a robot to get from a start point to one of a set of goal points. One goal point is chosen over the 

35 others because it minimizes movement of the robot. This known method is disclosed in L. Dorst et al., "The 
Constrained Distance Transformation, A Pseudo-Euclidean, Recursive Implementation of the Lee-algorithm", 
Signal Processing III (I.T. Young et al. eds; Elsevier Science Publishers B.V., EURASIP 1986) ("L Dorst et 
al."); and P.W. Verbeek et al., "Collision Avoidance and Path Finding through Constrained Distance 
Transformation in Robot State Space", Proc. Conf. Intelligent Autonomous Systems I, Dec. 8-11, 1986, 

40 Amsterdam pp. 627-634. The known method plans paths In the configuration space of the robot. Obstacles 
to robot movement are represented by forbidden states in configuration space. In this space, the series of 
set points is represented in so-called joint coordinates, this is a set of coordinates that can be used to drive 
the joints of the robot directly. No complicated coordinate transformations are needed. An advantage of the 
known method is the simplicity with which it can be expanded to greater numbers of degrees of freedom. 

45 In the past, the path in configuration space was found in three steps: 

1) A transformation is made of the obstacles and the goals of the robot from points in task space to 
states in configuration space. The configuration space is discretized. 

2) A cost field is created, specifying the total cost needed to reach the closest goal state at each 
state in configuration space. The particular method used to produce the cost field is described in L Dorst et 

so al. The method is a repeated scanning of the complete configuration space, while performing a basic cost 
propagation operation at each state. 

3) From the start state, steps are taken in the direction of the cost gradient of the cost field until the 
goal state is reached. The states passed on the way form the shortest path from start to goal, and can be 
used as the series of set points. Steps 1) and 2) are performed only once for a given robot and a given set 
of obstacles and goals. Using the same cost field, Step 3) can be performed for different start states. 
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The above method has a number of disadvantages. First, in step 2), the whole configuration space has 
to be scanned several times. Second, the kinds of cost metrics considered are restricted. In particular the 
cost of transitions between states in configuration space are considered to be the same for a given direction 
independent of the state at which cost is calculated. These restrictions limit practical applications. For 
s instance, it is not possible to find a path for a robot arm with revolute joints that will result in minimal 
movement of an end-effector. Minimal time paths are only possible for a few robots which are of limited 
practical application. A third disadvantage is that following the gradient requires computation of the gradient 
at every point of the path. 

In the prior art, a search technique known as A" was known, see ejg. N.J. Nilson, Principles of Artificial 
to Intelligence , Chapter 2 (Tioga 1980). 

After propagating cost waves, some aspect of the configuration space may change, for instance, if an 
obstacle is removed or a goal added, in such a case, it may be inefficient to repropagate cost waves 
through the entire configuration space, because only a small part of the configuration space may be 
affected. 

75 Another problem which arises after a change in configuration space is that the precise location of the 

changes, particularly in obstacle location, may not be known. 

An approach to this problem is set forth in V. Lumelsky, "Algorithmic and Complexity issues of Robot 

Motion in an Uncertain Environment", Journal of Complexity 3, 146-182 (1987); and V. Lumelsky, "Dynamic 

Path Planning for a Planar Articulated Robot Arm Moving Amidst Unknown Obstacles", Automatica, Vol. 23., 
20 No. 5, pp. 551-570 (1987). This approach suffers from certain shortcomings. For instance, the method 

disclosed is only able to deal with two dimensions. The method also does not have a memory for previously 

encountered obstacles. 

A number of research projects have considered the problem of electronic maps for vehicles. 

25 

SUMMARY OF THE INVENTION 

It is therefore inter alia an object of the invention to control the maneuvers of a vehicle with a non- 
neglectable size. 

30 It is a further object of the invention to control the maneuvers of a vehicle using techniques referred to 
herein as "budding" and "differential budding". 

It is still a further object of the invention to establish an efficient precedence for searching a 
neighbourhood of a given state in configuration space. 

These objects are achieved according to the invention in that the apparatus comprises means for 
35 storing an internal representation of a close environment of the vehicle, means for representing a pose of 
the vehicle in the given task space, which pose is measured in respect of a fixed point of the vehicle, and 
means for calculating a maneuver trajectory based on the internal representation. The close environment is 
a territory in which the maneuvering is performed: its size is within approximately the same order of 
magnitude as the size of the vehicle. 
40 These objects are further achieved according to the invention in that the fixed point is positioned at a 
point of symmetry with respect to the support. The vehicle has a rotatable or gliding support, for example' a 
wheel, a pair of wheels, one or more ski, a sleigh runner, etcetera. If this support is not steerable then 
choosing the fixed point at a point of symmetry with respect to the support leads to certain efficiencies of 
calculation: it is a pivot point of the vehicle. In case the support consists of a single wheel, ski or sleigh 
45 runner, this point of symmetry is situated at the center of the support. In case the support consists of two 
wheels, ski or sleight runners, the point of symmetry is situated midway between the two. With three 
wheels, the point is situated at the center of the middle wheel, etcetera. 

These objects are further achieved according to the invention by the use of cost metrics which are 
referred to herein as "space-variant metrics", 
so These objects are further achieved according to the invention by a process referred to herein as 
"following the direction arrows". 

These objects are still further achieved according to the invention by using the space-variant metrics in 
a multi-dimensional configuration space. 

The method of differential budding involves identifying a region in configuration space which is affected 
55 by a change of conditions in task space. Precisely selected states referred to as a perimeter and which 
define this region are then placed on a "sifting heap" from which they are budded. 

In the case of an added obstacle, the perimeter includes the front edge of the obstacle as well as 
surrounding a group of states which are connected via direction arrows to the back edge of the added 

3 
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obstacle. 

In the case of removed obstacles, the perimeter states are neighbours of the removed obstacle states. 
In the case of added goals, the perimeter states are the added goals themselves. 

In the case of partially sensed changes in conditions, the changes in conditions are detected while 
5 following a precalculated path. Most changes in conditions can then be dealt with as an added obstacle, a 
removed obstacle, an added goal, or a removed goal. In one embodiment of the invention, the object first 
encounters a portion of the change in conditions iteratively follows a newly calculated path unitl the change 
in conditions is taken into account. 

Further objects and advantages of the invention will become apparent in the remainder of the 
io application. 



BRIEF DESCRIPTION OF THE DRAWING 

75 These and other aspects of the invention are described herein with reference to the selected 
embodiments illustrated in the following Figures. 

Figure 1a is a high level flowchart giving a conceptual view of the method of path planning. 

Figure 1b is a more detailed flowchart of box 154 of Figure 1a. 

Figure 2 shows a data structure used as a configuration space. 
20 Figure 3 is a flowchart of an alternate embodiment of the method of path planning called "budding". 

Figure 4 is a summary flowchart of the differential budding method. 

Figures 5 and 6 are flowcharts giving more details of box 1 10 of Figure 4. 

Figures 7 and 8 are flowcharts giving more details of box 120 of Figure 4. 

Figures 9 and 10 are flowcharts giving more details of box 130 of Figure 4. 
25 Figure 1 1 shows a flowchart for dealing with phantom changes in condtions. 

Figure 12 is a schematic illustration of a vehicle in task space. 

Figure 13 illustrates a transformation of a neighbourhood into task space. 

Figures 14 a, b, c, and d illustrate obstacle transformation from task space to configuration space. 
Figure 15 is a screen image of a sun workstation running a simulation. 
30 Figure 16 is an illustration of the precedence of search of a given set of neighbours. 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 



A. Definition of Some Terms 

A robot has degrees of freedom. The degrees of freedom are the independent parameters needed to 
specify its position in its task space. Some examples follow. A hinged door has 1 degree of freedom. In 
other words, any positiion can be characterized by one parameter, an opening angle. A robot which moves 
freely over a factory floor has two degrees of freedom, for instance the x- and y-position coordinates. An 
object in space can be considered to have six degrees of freedom. The 6 independent parameters that 
need to be specified are three position coordinates and three orientation angles. Therefore in order for a 
robot to be capable of manipulating an object into an arbitrary position and orientation in space, the robot 
must have at least six degrees of freedom. An example of a commercially available robot with six degrees 
of freedom is the Puma 562, manufactured by Unimation, Inc. 

A rotational degree of freedom is a degree of freedom that corresponds to an angle about a rotation 
axis of a robot joint. A rotational degree of freedom is a periodic parameter with values running from 0° to 
360°; i.e. 360° corresponds to the same configuration of the robot as does 0°. Translational degrees of 
freedom correspond to non-periodic parameters that can take on values over an infinite range. Usually, 
however, the ranges of both rotational and translational degrees of freedom are limited by the scope of the 
robot. 

The "configuration space" of a robot is the space spanned by the parameters of the robot. The 
configuration space has one dimension for each degree of freedom of the robot. Herein, a point in 
configuration space will be called a "state". Each "state" in an n-dimensional configuration space is 
characterized by a set of n values of the n robot degrees of freedom. A robot in the position characterized 
by the set of values is in a certain configuration. The set of states in the configuration space corresponds to 
the set of ail possible robot configurations. 
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For the purpose of computation, the configuration space is "discretized". This means that only a limited 
number of states are used for calculations. 

Figure 2 shows a data structure 203 which is used as the configuration space of a robot with two 
degrees of feedom. Data structure 203 is an MxN matrix of configuration states. The states are identified by 

5 their indices (i.j), where i represents a row number and j represents a column number. Each state (ij) is 
itself a data structure as shown at 201 and has a cost_to_goal field 202 and a direction_arrows field 204. 
These fields are filled in by "budding" as described below. The cost_to_goal field 202 generally contains 
a number which represents the cost of transition to get from the present state to a nearest "goal state". 
"Goal states" represent potential end points of the path to be planned. 

to The cost of a transition in configuration space is a representation of a "criterion" or constraints in task 
space. A criterion is a cost according to which a user seeks to optimize. Examples of criteria that a user 
might choose are: amount of fuel, time, distance, wear and tear on robot parts, and danger. 

The direction_arrows field 204 can contain zero or more arrows which indicate a direction of best 
transition in the configuration space from the present state to a neighbour state in the direction of the goal 

75 state resulting in a path of least total cost. 

Arrows are selected from sets of permissible transitions between neighbouring states within the 
configuration space. The term "neighbour state" is used herein to mean a state which is removed from a 
given state by a single permissible transition. One set of arrows could be {up, down, right, left}, where, for 
instance, "up" would mean a transition to the state immediately above the present state. Another set of 

20 arrows could be {NORT, SOUTH, EAST, WEST, NE, NW, SE, SW}. Yet a third set of arrows could e {(0,1). 
(1.0). (0,-1), (-1.0), (1.1). (1.-D. (-1.D. (-1.-D. 0.2). (-1.2). 0.-2), (-1.-2), (2,1). (-2.1). (2,-1). (-2.-1)}. It is noted 
that the arrows "up", "NORTH", and "(-1.0)" are all representations of the same transition within the 
configuration space. In general one skilled in the art may devise a number of sets of legal transitions 
according to the requirements of particular applications. Once a set of legal transitions is devised any 

25 unambiguous symbolic representation of the set of permissible transitions can serve as the direction arrows. 
In the case of the directions (1,2), (-1,2), (1,-2). (-1,-2), (2,1), (-2,1), (2,-1) and (-2,-1), transition to a 
"neighbour" state in a two dimensional matrix 203 actually requires a "knight's move", as that term is 
known from the game of chess. For example (1.-2) represents the move in the neighbour direction "down 
one and right 2". 

30 In the configuration space, a metric is defined. The "metric" specifies for each state in configuration 
space the cost of a transition to any neighbouring state. This metric may be specified by a function. For 
instance, a locaily Euclidean metric can be defined as follows. At a state (i.j). the cost of a transition in a 
neighbour removed from (ij) by direction arrow (di.dj) is given by SQRT(dixdi + djxdj). In other situations, it 
is more convenient to compute the metric in advance and store it. Obstacles can be represented in the 
35 metric by transitions of infinite cost. A transition between two arbitrary states must take the form of a series 
of transitions from neighbour to neighbour. The cost of any arbitrary path from a start state to a goal state is 
the sum of the costs of transitions from neighbour to neighbour along the path. 

In budding, a standard data structure called a heap is used to maintain an ordering of states. This is 
only one of many possible schemes for ordering, but the heap is considered to be the most efficient 
schedule for implementations with a small number of parallel processors. The heap is a balanced binary 
tree of nodes each representing a configuration state. In the preferred embodiment, the nodes actually store 
the indices of respective configuration states. In the heap, each parent state a lower cost_to_goal than 
either of its two children states. Therefore, the state at the top of the heap is that with the least value of 
cost to goal. Heaps are well known data structures, whcih are maintained using well known methods. One 
45 descTiptkTn of heaps and heap maintenance may b.e found in Aho et al.. The Design and Analysis of 
Co mputer Algorithms , (Addison-Wesley 1974) pp. 87-92. In an alternate embodiment, other ways of 
ordering states may be used during budding. For instance, a queue can be used. This means that nodes 
are not necessarily budded in order of lower cost. 



40 
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B. Overview of Budding 

Figure 1a gives a general overview of steps used in generating a series of set points using the method 

of the invention. . 

In box 150 the configuration space is set up and permitted direction arrows are specified. One skilled in 
the art might devise a number of ways of doing this. 

One option offered by the method is that of specifying aspects of the configuration space interactively. 
The number of states in a configuration space might be chosen to reflect how finely or coarsely a user 
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wishes to plan a path. The set of direction arrows may be chosen to be more complete to get finer control 
of direction. The set of direction arrows may be chosen to be less complete if speed of path planning is 
more important than fine control of direction. 

Other ways of specifying the configuration space and direction arrows are to code them into a program 
or hard wire them into circuitry. These options provide for less flexibility, but can result in increased 
processing efficiency. 

In box 151, a "background metric" is induced by a criterion. A background metric is one which applies 
throughout a configuration space without taking into account local variations which relate to a particular 
problem. Another option offered by the method is to specify the transition costs interactively. 

In box 152 obstacles and constraints are transformed from task space to configuration space. This 
transformation generates obstacle states and/or constraint states, in addition or alternatively the transforma- 
tion can represent obstacles and constraints as part of the metric. Boxes 151 and 152 are represented as 
separate steps in Figure 1a, but in fact they can be combined. 

in box 153, goals are transformed from points in task space to one or many goal states in configuration 
rs space. 

In box 154 "budding" occurs. "Budding" is explained below. Budding results in filling the 
direction_arrows fields of the configuration space with direction arrows. 

In box 155, a start state is identified. The start point in task space can be input by a user, or it can be 
sensed automatically, where applicable. This start point must then be transformed into a state in 
configuration space. If robot encoders are read, or the command WHERE in Val II is used, one obtains the 
parameters of the start state immediately, without any need for transformations. The WHERE command 
returns the joint encoder angles in degrees. 

In box 156, the method follows the direction arrows set up in box 154 from the start point indicated in 
box 155 to the goal state. The path states passed through in box 156 are sent to a robot at 157. The path 
25 can be sent in the form of set points. Each set point can then be a parameter of a MOVE POINT() 
command in Val II. The set points can be transformations into task space of the path states passed through 
in box 156. In an appropriate application, the set points can be the path states themselves. As will be 
discussed below, in some applications the set points need not be used to direct a robot. They can also be 
used as instructions to human beings. 

30 The method described in the flowchart of Figures la and 1b is applicable to a large number of different 
situations. 

Although the path planning problem given is that of moving from a starting position to a goal position 
the solution is actually found by propagating cost waves starting at the goal toward the start. The transition 
cost for moving from state "a" to a state "b" calculated during ,7 buddin~represents the cost that will be 
35 incurred while following the path states through b to a. 

"Propagating cost waves", here, is treating layer after layer of unprocessed states. If a queue is used to 
schedule budding, unprocessed states are treated first in, first out. If a heap is used, then the lowest cost 
node will always be budded first. 

Cost criteria can be selected according to the needs of a particular application, for instance: minimizing 
40 time, minimizing distance travelled, minimizing joint movement. The transition cost of movement is not 
symmetric. A transition from state A to state B may be more expensive than a transition from state B to ■ 
state A. 

The metric for transition costs between states of the configuration space is different from the cost 
criterion of movement in the task space, because cost waves are propagated from goal state to start state, 
45 in other words the transition costs are associated with transitions in configuration space. 

When cost of movement varies depending on location in configuration space a "space- variant metric" is 
required. 

Figure lb expands box 154 of Figure 1a. 

In box 150 of Figure 1a, uncosted values U are assigned to the cost_to_goal field of each 
so configuration state, and all the direction_arrows fields are cleared. 

In box 152 infinite values INF are set in the cost_to_goal field of configuration states which represent 
obstacles. In addition, the boundaries' of the task space are obstacles. 

Box 153 assigns zero 0 to the cost_to__goal fields of the configuration states which represent goals. 
There may be one or many goals. Also in box 153, the indices of the goals are added to a heap. Standard 
methods of heap maintenance are employed for addition and removal of states to/from the heap. As a 
result, the state with the lowest cost will always be the top state of the heap. 

Box 14 of Figure 1b checks to see if the heap is empty. If the heap is empty, the algorithm takes the 
NO branch 15 to box 16. Box 16 takes the smallest cost item from the heap (top state), using a standard 
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heap deletion operation. ^. . . . ^ „ _ t _ toc 

Box 17 tests whether all the neighbouring states have been checked. Netghbour states are those states 
which are immediately adjacent to the top state. If the neighbouring states have not been checked, the 
method takes the NO branch 181 from box 17. 
s in box 18 the transition cost between the top state and its neighbouring states is calculated us.ng the 
metric function. Transitions to obstacle states can be represented as "INF" Box 18 lf^ eseach 
transition cost one at a time as part of the loop which includes boxes 17, 18, 19. 120, 121. 122 ana i«. 

Box 19 compares the sum of the transition cost and the contents of the cost_to_goal field of the top 
state with the contents of the cost_to_goal field of a current neighbouring state. If a state is in its 
w condition, the contents of the cost_to_goal field will be U. uncosted. One way te » £P£™J " ' s *° 
assign to the cost_to_goal field a value which exceeds the largest possible va^u e , for the onbgu ation 
space, other than INF. If the comparison in box 19 gives a comparison result of < . the method takes 
branch 124 to box 121. Following branch 124 will be referred to herein as "improving" a state. 

In box 121 the cost_to_goal field of the neighbour state is updated with the new (tower) 
cost to goal. i.e. the sum of the transition cost and the contents of the cost_to_goal field. In addition, 
box i2lTdds an arrow pointing to the top state in the direction_arrows field of the ne.ghbouring state. 
In box 122. which follows box 121. the indices (i.j) of the neighbouring state are added to the heap 
The method now returns control to box 17. This return results in a loop. The method executes boxes 
17 18 19 121 and 122 for each of the neighbouring states, other than an obstacle. For an obstacle, the 
method takes branch 126 to box 125. Since the transistion cost is infinite, branch 127 is taken from box 125 

to return control to box 17. . 

The above-described process of: exploring all of the neighbours of a first state; assigning appropriate 
costs and direction arrows to neighbours; and adding "improved" neigbouring states to the heap, is referred 

to herein as "budding" a state. . 19fll , 

25 After budding the current top state, all neighbour states have been checked, so the yes branch 128 .s 
taken from box 17. If the heap is not empty at box 14, branch 15 is taken. 

In box 16, the next top state is retrieved. This is the smallest cost item which is on top of the heap. 
If no impact can be made to any neighbour of a top state, no changes are made to the >c°£Q<">™ 
space during that iteration. If the sum of the transition cost to a current ne.ghbour state and the top state s 
30 cost to goal is greater than the neighbour's preexisting cost_to_goal. branch 124 is not tatan. No 
improvement can be made. Branch 129 is taken instead, returning control to box 17. Taking branch 129 is 
referred to herein as "not impacting" another state. „, „ efatQ 

It is possible that box 19 can reveal more than one equivalent path from a current ne.ghbou state 
which corresponds to branch 123. In box 120. an "alternative arrow" is added to a ne.ghbour. but not to the 
3S heap, when an equivalent path is found. The direction_arrows field can contain more than one arrow as 

illustrated in 204 of Figure 2. 

Once the heap is empty, branch 130 is taken and budding is completed. 

Once the budding of all the states of the configuration space is finished, a path can be followed from 
any starting position to the goal by simply following the direction_arrows values. The cost in each 

40 configuration state gives the total cost required to reach the goal from that state. 

Situations may occur where transformed obstacles may completely separate the start state from the 
goal state. In such situations, when budding has completed, there will be no arrows at the starting state. 
This indicates that there is no path to the goal from this starting state. 

One skSled in the art might devise a number of ways of determining which regions ,n configure .on 
45 space correspond to an obstacle in task space. One simple way of making this determ.nation. >s to simulate 
each state of the configuration space one by one in task space and test whether each state corresponds to 
hftting he obstacle Standard sofid-model.ing algorithms may be used to determine whether the object for 
which a path is planned hits the obstacle in task space. One such set of algorithms .s .mplemented by 
repTesiCsurfaces using the B-rep technique in the Silma package sold by SILMA, 211 Grant Road, Los 

50 A,t0 L C m A efim°es 2 a configuration space will be periodic. For instance, when the object for which a path is 
planned is a robot, the axes of the configuration space may be the joint angles of the robot In this case the 
configuration space will be topological* equivalent to a torus, and paths may wrap around its edges. 

States with equal cost_to_goal are located on what appear to be equal cost wave rente ^ow,ng out 
55 from the goal. For this reason, in the art the term "propagating cost waves" has been used to describe the 
process of assigning direction arrows to states in configuration space. 

An efficiency technique that can be used with budding is "early path detection". The early path 
detection feature makes use of the fact that as soon as the cost waves have been propagated ,ust beyond 
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the starting state, the optimal path can be reported, since no further budding changes will affect the region 
between the start and goal. 

Figure 3 shows the additional steps necessary for early path detection. Figure 3 is the same as Figure 
1b, except that several steps have been added. In box 301. the method tests whether the value of the 

C ,° S t ~ «V ? ° f the St3te 31 thS t0p 0f the heap is 9 reater than the c °st to goal field of the start 
state If the result of the test of box 301 is negative, budding continues as usual alo"ng branch 302. If the 
result of the test of box 301 is positive, the method follows branch 303 to box 304 where the path is 
reported After the path is reported at box 304, normal budding continues. It is possible to stop after this 
early path detect.on if the entire cost field is not needed. This kind of early path detection is not possible if 
a queue structure is used during budding, instead of a heap because using a queue structure the shortest 
path cannot be determined until the entire configuration space is budded 

Another efficiency technique is to begin budding from both the goal and the start states. The path then 
is found when the expanding cost waves meet. Usually, a different metric must be used for budding the 
start state from that which is used for budding the goal states. This results from the fact that budding out 
from the start state would be in the actual direction of motion in the task space which is essentially calling 
the same metnc function with the top and neigbhour states swapped. By contrast, budding from the goal 
states is in a direction opposite to motion in the task space. 



20 C. Overview of Differential Budding 

Figure 4 gives a general overview of steps used in "differential budding", a method for regenerating a 
configuration space with changes in obstacles and goals. The resulting configuration space provides 
information necessary to generate a series of set points to be followed for an optimal path 
25 In box 400. a configuration space filled with direction arrows and costs to goal is assumed 
Information about changed goals and obstacle states is also assumed to be prodded: These states are 
already transformed from task space to configuration space. It should be noted that the method will work if 
the conf.gurat.on space is merely initialized, with UNCOSTED in each cost_to_goal, and no direction 
arrows* 

30 . ., bo * 410, informa «°n about newly added obstacle states and newly removed goal states is used to 
initialize the corresponding states in configuration space. 

. S^Sl*' StateS " influenced " b V th e added obstacle and removed goal states are initialized to 
have UNCOSTED values and no direction arrows. "Influenced" neighbours are those that are on paths that 
point to or through these added obstacle or removed goal states. The "perimeter" of states around this 
35 region is obtained and added to the heap for later "budding". 

In box 430, information about newly removed obstacle states and newly added goal states is used to 
initialize the corresponding states in configuration space. The heap is set up so that "budding" can take 

piclC©. 

In box 440, the states on the heap accumulated as a result of boxes 410, 420, and 430 are "budded" 
40 resulting in a stable (valid) configuration space. Given a starting state, an optimal path of set points can be 
read out by following the direction arrows in configuration space to the goal state. 

Two special structures are used for efficiency: a sifting heap, and a sifting array. The "sifting heap" is a 
regular heap except that it keeps at most one copy of a tuple (state) in the heap even though many 
requests to add extra copies may be made. Whenever the word "heap" is used herein, a "sifting heap" is 
intended. The "sifting array" (used to store unique states of the perimeter) is similarly a regular array 
except that it keeps at most one copy of a tuple (state). Some of the arrays referred to herein are sifting 
and some are not. In both cases, sifting is achieved by maintaining flags in each state of the configuration 
space that report if a state is in the heap or in the perimiter array. Then all that is needed when adding or 
removing states from the heap or perimeter is to modify these flags correctly. 

The method in box 410 is detailed by the flowchart of Figure 5 and Figure 6. The method of box 420 is 
detailed by the flowchart in Figure 7 and Figure 8. The method of box 430 is detailed by the flowchart of 
Figure 9 and Figure 10. 



45 



so 



55 L Check added obstacles and removed goals 

The "check added obstacles and removed goals" method of box 410 includes three main parts 

The f.rst part is shown in boxes 500. 510. and 520. Box 500 tests whether the end of the "added 
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obstacle" list has been reached. If the result of the test in box 500 is "Yes", control passes to box 530. If 
the result of the test in box 500 is "No", control passes to box 510. Box 510 gets the next obstacle state 
"S" from the added obstacle list. Box 520 then clears the direction_arrows field and sets the 
cost to_goal field to INF in the state "S". After box 520, control is returned to box 500. ^ 
s Boxes 500, 510. and 520 thus constitute a loop which initializes each "added obstacle" state ( S ) in 
configuration space to have no direction arrows and an INF (INFINITE) cost__to_goal. 

The second part of the "check added obstacles and removed goals" method of box 410 is shown .n 
boxes 530, 540 and 550 of Figure 5. and boxes 600, 610, 620. 630, 640, and 650 of Figure 6. It should also 
be noted that line 501 of Figure 5 connects to line 601 of Figure 6; line 502 of Figure 5 connects to line 602 
jo of Figure 6; and line 503 of Figure 5 connects to line 603 of Figure 6. 

In this second part of box 410, the "front edge" of the obstacle and the "back edge" of the added 
obstacle are obtained. The "front edge" contains those neighbour states that are on the "goal side" of the 
added obstacle. These states are neigbhours of the obstacle region, have cost values other than INFINITY 
or UNCOSTED, and are not pointing toward any of the obstacle states. The "back edge" contains those 
neighbour states that are not on the front edge. These states have direction arrows that point into the added 
obstacle. 

Box 540 signifies a test for the end of the "added obstacle" list. If the end has been reached, control 
passes via line 501/601 to box 660. If the end has not been reached, control passes to box 550. where an 
added obstacle "A" is retrieved. 

Then at box 600, it is determined whether all of the neighbour states "N" of the obstacle state A have 
been considered. If all of the neighbour states "N" have been considered, control returns via line 603/503 to 
box 540. If a neighbour state "N" has not been considered, control passes to box 610, where that state N 

is retrieved. ■»-«*♦ 
Box 620 indicates a test of whether the state "N" contains a direction arrow that points to A . if state 
25 "N" does not contain such a direction arrow, control passes to box 640. If state "N" does contain such a 
direction arrow, the state "N" is added to the heap at box 630. If the state "N" is added to the heap at box 
630. "N" is considered to be part of the "back edge" of the added obstacle. After box 630. control returns 
to box 600. 

In box 640. "N" is tested for whether its cost_to_goal field contains INF. If "N" does have a 
so cost_to_goal of INF. control is returned to box 600. If "N" has a cost_to_goal other than INF. it is added 
to the "perimeter list" at box 650. and is considered part of the "front edge" of the obstacle. 

The third part of the "check added obstacles and removed goals" method of box 410 is shown in boxes 
660 670 and 680 of Figure 3. These three boxes form a loop. In box 660. it is determined whether the end 
of the "removed goals" list has been reached. If the end has been reached, the "check added obstacles 
35 and removed goals" method is complete. If the end has not been reached, the next goal state "G" is 
retrieved at box 670. This goal state "G" is then added to the heap at box 680 and control is returned to 
box 660. Thus, in this loop, each of the removed goals states in the "removed goal list" is added to the 
heap. 



15 
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40 



ii. Clear influence 



The "clear influence" method of box 420 includes two main parts. The first part determines the 
"perimeter of influence" due to the newly added obstacle and removed goal states, and the second part 
4s takes the perimeter and puts it into the heap. ,„« ,.,„ 7 , n 7J .n 

The first part of the "clear influence" method of box 420 is shown in boxes 700. 710. 720. 730. 740. 
750 760 and 770 of Figure 7. and boxes 800, 810 and 820 in Figure 8. It should be noted that line 701 o 
Figure 7 connects to line 801 of Figure 8. line 702 of Figure 7 connects to line 802 of Figure 8. line 703 of 
Figure 7 connects to line 803 of Figure 8. and line 704 of Figure 7 connects to line 804 of Figure & 
so At the beginning of the "clear influence" method, the heap consists of neighbour states at the back 
edge of any added obstacles and any removed goals states. At box 700. the heap is tested to see if it is 
empty. If the heap is empty control passes via line 701/801 to box 830. 

If the heap is not empty, then, at box 710. a minimum cost state "S" is retrieved from the heap and a 
variable, uncostflag. corresponding to "S" is set to "NO". At box 720. it is then determined whether all 
55 neighbours, "N", of "S" have been considered. If all the neighbours have been considered, control passes 

to box 760.^ the . nejghbours havQ not been COJ1sideredi th e variable uncostflag is tested at box 730. If 
uncostflag has a value "No" then, at box 740, "S" is added to the perimeter, if "S" has not already been 
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2?? Im^nT I unc ° stfla 9 has a value "Yes", then, at box 750. the cost to goal field of "S" is 
set to UNCOSTEp; the d. recti on_arrows field of "S" is cleared; and all neighbour from the "Bag" array 
are emptied into the heap which sifts them. i.e. it does not store any duplicate states 

s if it SaZlm^n^S*^ T iS retrieVed - At b0X 770 the c °st_to_goal field of "N" is tested to see 
s if it .s either INF or UNCOSTED. If it is neither, control passes via line 702/802 to box 820. If it is either INF 
or uncosted. control passes via line 403/503 to box 500. 

bov??n b °.f !!V S " iS C „ t ! eC * ed t0 . 566 if H haS 3 direction arrow P° intin 9 to " N "- » not. control passes to 
box 820. If so, the uncostflag associated with "S" is set to "YES" 

io 804/?04 b to X box°720 e " temp0rari,y Stored in the Ba 9 arra V- Control then returns via line 

Thus, during the first part of the "clear influence" method of box 420. each state "S" in the heap that 
aZUfJZZ? hb 7 ( : N 7 hat haS 3 cost -*-9° a ' that is either INFINITE or UNCOSTED is identified 
fral JT mUS , ? h3Ve b6en " connected " via Erection arrows to the back of a new obstacle 

n ™h „1 ,h rem ° V t 9 ? Stat8 - Any nei 9 hbour that is INFINITE or UNCOSTED is a candidate for 
3Ti^3?h" d 1 'cT P ° rari,y St0red in the " Ba 9'' Th * "Bag" is a standard array containing 
Hie Baa" are adrtari r ? JT exa " )ined ' if " S " is c o™ected, then all neighbours of »S" that are in 
cost 2 ooa of ^EyiS? , 1 1*" ^ W " iCh SiftS them ' and " S " is initialized to have 
then-S-mnS hi » 1 D Au d "° d ' reCti0n arr ° WS - ' f " S " iS not c °™ected. "No" branch from box 730. 
20 the heap "perimeter" and the neighbours that are in the "Bag" are NOT added to 

Rou-ftT^ «S °1 "° lear influence " method of box 420 is shown in boxes 830. 840 and 850 of 
«^ method ends. If not. a penmeter state "P" is retrieved 840 and added 850 to the heap, if not 

25 me sfates JtSS T ^.p 50 " control is returned to bo * «0- ^ n ' s second part of box 420 thus reads 
25 the states in the "perimeter list" and stores them in the heap. 

^Thusllia p^mater Itet can be said to surround an influenced or "affected region" of the configuration 
space and th,s term.nology has been used herein. The term "influenced" is used herein particularly to refer 
Ixll^Tl U M nCe St8P .K 420 a " d iS distin 9 uished f ™ the term affected, which is used more bmadly as 
so IX Zil IZh *T te "T in ° l09y iS 001 meant t0 imply that the surrounded region contains the 

mav hte theS IT T 9 !? 35 3 M ° f diff6rential buddin9 ' States on or the perimeter 

4T0 o^ RgJre 4 COSt - t0 - 90al ° r d ' rec »on_arrows values changed as a result of budding the heap in box 
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35 iii. Check removed obstacles and added goals. 

The "check removed obstacles and added goals" method of box 430 has three main parts 

"r e mn„ e J r nh P r rt . iS ..??r "J"™ 5 9 °°' 910 and 920 ' At box 900 ' '* is ^termined whether the end of the 
e h T ?.? 38 b6en reaChed - ' f the end has neen reached - oontrol Passes to box 930. If the 

40 end has not been reached, a next obstacle state. "S". is retrieved from the list at box 910. In this state. "S" 
he d.recfcon_arrows field is cleared and the cost_to_goal field is set to UNCOSTED. This first part is." 
aTws ^Z unrT™ " rem ° Ved ° bSt3Cle " St3te c ° nfi 9uration space to have no direction 

ZrZe* fth , , ♦ f ? cost - to -9oa'- ^ are appropriate values, since these now unoccupied 
JTITT 0 ° bstacl !, state J s have no Plumed costs or arrows. These removed obstacle states can be said 
£ n ♦ h IT? . , by the ° bStaC,e rem0val ' and tnis terminology is used herein. However, it should 

be noted that states outside this "affected region" may still have their cost to goal and direction arrows 
h i 9 38 3 reSUU ° f budding box 44 °- Tne stat es surrounding" th7 removed obstacle-can be 

goals !°«?SSrSSJ T ^ feqUire 3 ,6SS S0PhiStiC3ted tre3tment th3n the Perimeter of the 

50 lOSO^ndTn 0 ^^ ° f Tn 4 , 30 Vf™" b ° XeS 93 °' 940 and 950 of Fi 9" r e 9 and boxes 1000. 1010. 
IonLt« ♦ ? l^i 1 °' L ' ne 901 0f R9ure 9 oonnocts to line 1001 of Figure 10. line 902 of Figure 9 
connects to line 1 002 of Figure 1 0. and line 903 of Figure 9 connects to line 1 003 of Figure 1 0 

940 ^ S in e h 0n onn art t 0f JT 43 ° ^ * the t0p ° f *» removed obstac,e list ' at 930 - A test is performed at 
« ! 4 h k k 900. to determine whether the end of the "removed obstacle" list has been reached. If the 

1JT ?? .fo.". C ° ntr °! P3SSeS Via " ne 901/1001 ,0 box 1040 - ,f the end has not been reached, a 
"R^tf T ' a r t' 6Ved 3t 95 °- Then ' in bOX 1000 ' jt is d etermined whether all neighbours of 
JL ™« nf e R.. COnS ' dered J f SO ' COntr °' iS p3SSed via ,ine 1003/903 to box 940. If not. a next neighbour 
state N of "R" ,s retneved at 1010. If "N" has a cost_to_goal field which has a value of UNCOSTED or 
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INF, then control is returned to box 1000. If "N" has a cost — to__goal field which is not UNCOSTED and not 
INF, then "N" is added to the heap at 1030. 

Thus, in this second part of box 430, all neighbours of a removed obstacle state that have a 
cost__toJ_goal other than "INFINITY" or "UNCOSTED" are added to the heap, which sifts them. These 
5 states together form an edge that is adjacent to the removed obstacle. These neighbouring states will help 
(via the "budding" mechanism of box 440) to fill in the vacated area where the "removed obstacle" states 
reside. 

The third part of box 430 is shown in boxes 1040, 1050, 1060 and 1070 of Figure 10. At box 1040, a 
test is performed to determine if the end of the "added goals" list has been reached. If the end has been 
w reached, the "check removed obstacles and added goals" method terminates. If the end has not been 
reached, a next goal state "G" is retrieved at 1050. At 1060. for the goal "G", the di recti on_arrows field is 
cleared and the cost__to__goal field is set to zero. Then, at 1070. the goal "G" is added to the heap and 
control is returned to box 1040. 

Thus, this third part of box 430 is a loop which takes each newly added goal state from the "added 
75 goals" list clears the direction arrows, sets the cost_jo_goal to zero, and adds each goal state to the 
heap. -Thus the added goal states are both the "affected region" and the perimeter as that terminology is 
used herein. However, it should be noted that states outside this "affected region" may still have their 
cost_Jo_goal and direction_arrows values changed as a result of budding in box 440. 

In summary, then, the "affected region" as that term is used herein means states that have been 
20 cleared as part of the clear influence step 420, and states corresponding to removed obstacles and added 
goal states which are "influenced" are the ones cleared during the clear influence step 420. 

Differential budding can also handle the situation where some new information is discovered while an 
object is already moving on a prescribed path. This arises when the object does not have a vision sensor, 
or has a faulty one. but does have a proximity or tactile sensor of some kind, or when discretization of the 
25 configuration space leads to some errors in motion which must be corrected along the way. This. can also 
arise where stored information becomes out of date. In many cases an object may be able to learn about an 
environment simply by moving around, acquiring information about new obstacles or goals or. removed 
obstacles or goals as it encounters them, and incorporating this knowledge into its configuration space. The 
object can also adapt to a changing environment even if the vision sensors are not perfect. In such cases 
30 new information can be regarded as added or removed obstacles or goals. New obstacles can be detected 
by encountering different parts of the obstacle while following iteratively developed new paths. 

Figure 1 1 is a flow chart which summarizes the iterative approach to dealing with unsensed or partially 
sensed changes in conditions. 

In box 1101 the method determines a next state in a precalculated path, by following direction_arrow 

as values from a current state. 

In box 1 102 the method sends a set point to a motion controller for the robot, based on the next state. 
At box 1103 a test is performed to determine whether a sensor associated with the motion to the next 
state has detected new information. If no new information is detected, control returns to box 1101. 

If new information is detected there are two options. If the new information is not an absolute obstacle 
40 to movement control may optionally return via the dotted line: 1104 to box 1101. The dotted line 1104 
represents a situation in which movement is chosen over calculation of a new optimum path. The dotted line 
1104 is chosen, in other words, when movement is more important than strict optimality. 

While the dotted line 1104 is taken, a processor could be incorporating new information into a 
configuration space while motion continues. Such parallel processing could be useful when the new 
45 information does not immediately affect the motion on the precalculated path. For instance, if the method is 
applied to control of emergency vehicles, an emergency vehicle might report a traffic blockage in a lane of 
opposing traffic. Such a report need not affect the progress of the emergency vehicle which reports the 
blockage. In this case of the emergency vehicle, the vision of the driver is the proximity sensor. 

If the dotted line 1104 is not taken, and new information is sensed, control passes to box 1105. In box 
so 1105. the new information is incorporated into configuration space. At 1106, differential budding occurs, for 
instance using boxes 410-440 of Figure 4. 
After 1106. control returns to box 1101. 



55 D. Precedence of Search of Neighbours 

The search of the neighbours in box 17 must occur in particular order as soon as there are more 
neighbours than the set {(1.0), (0.1), (-1.0), (0.-1)}. The search of box 17 should never allow searching a 
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neighbour which is beyond a neighbour blocked by an obstacle. For instance, given the set of neighbours 
{(1,0), (0,1), (-1.0). (0,-1), (1,1). (1,-1). (-1,1), (-1,-1), (2,1), (1,2). (2. -1), (1,-2), (-2,1), (-1,2), (-2,-1), (-1,-2)}, 
the neighbour (1,1) should never be searched unless both (0,1) and (1,0) have been searched and are free 
of obstacles. If either (0.1) or (1,0) is blocked, it should be assumed that, (1,1), which is beyond both of 
them, cannot be reached safely. Similarly. (2.1) should not be searched unless (1,1) has heen searched and 
is free of obstacles. Neighbour (0,1) does not have to be searched a second time in order to determine that 
it is safe to search neighbour (2,1), because (1,1) would not have been searched unless (0,1) was clear. 
Precedence of search is necessary to find safe paths through configuration space, but it also results in a 
benefit of making the search of box 17 more efficient, because not all neighbours will always be searched. 
Figure 16 shows the precedence of search amongst the neighbours in the set {(1.0), (0,1). (-1.0), (0,-1), 
(1.1). (1.-D, (-1,1), (-1,-1). (2.1), (1.2), (2,-1), (1,-2), (-2,1), (-1.2), (-2,-1), (-1,-2)}. The dotted lines in Figure 16 
represent the fact that the picture, wraps around at the ends, with (-1.0) able to appear at either end. 

While this example gave a particular precedence for a particular application, those of ordinary skill in 
the art will be able to design other precedences which make sense for other applications. 

In accordance with the chosen precedence, a representation of the neighbour states can be stored in a 
neighbour memory, using a tree structure. If a blocked neighbour state is found during the search, then 
subtrees of this blocked neighbour state need not be searched any more. These subtrees can be skipped. 
Thus, using standard methods of tree maintenance, higher efficiency is obtained. 



E. Application of Budding and Differential Budding to Maneuvering a Vehicle 



One possible application of budding and differential budding is maneuvering a robotic vehicle. The word 
"maneuver" is used herein to mean small movements, i.e. movements which have a size which is within 
approximately the same order of magnitude as the size of the robotic vehicle, as opposed to large 
movements, such as would be planned with an electronic map. A robotic vehicle may be maneuvered into, 
for example, a tight parking space; a three point turn, or an ordinary turn. Such maneuvers are often difficult 
for the operator of a robotic vehicle to plan because of imperfect knowledge of the size and maneuverability 
of the vehicle. 

In what follows, an example of the application of budding and differential budding to maneuvering a 
robotic vehicle is given. The example is of an ordinary car with front wheel steering. 

The car can be regarded as a robot with three degrees of freedom. Three parameters (x,y,<f>) will be 
used herein as axes of a configuration space for the car, where x and y define a location of the car in 
Cartesian coordinates and $ represents its angle. 

The "Cartesian point location" of the car (x.y) is taken to be at a point midway between its non-steering 
wheels. In most cars, this point Is at the rear differential of the car, because in most cars steering is effected 
with the front wheels. This particular point is chosen because it leads to certain efficiencies of calculation, 
which will be described below. However, any point consistently related to the position of the car may be 
chosen. 

In addition to having a point location, the car is assumed to be contained within a rectangle having a 
width and length. The rectangle is also assumed to have an angle relative to a fixed reference angle. 

Figure 12 illustrates a schematic task space of a car 1202, with a cross 1201 at its Cartesian point 
location. Two obstacles 1203, 1204, which could be parked cars, are shown. 

The car 1202 is considered to be located at an (x,y) position at the Cartesian point location 1201 and at 
an angle <*>, here pictured at about 235°. In this example, the 235° is measured from a fixed reference angle 
0° which is parallel to the curb 1206 and has a direction from box 1204 to box 1203. The units chosen for 
this example were arbitrary, with the care 1202 being 3 units long. The discretization, illustrated by the grid 
is chosen so that the x and y axes in configuration space each have four states per distance unit. Thus the 
car is 12 states long. The discretization was also chosen so that the angle <j> could assume 64 different 
values. In other words, the periodic axis <*> in configuration space has sixty-four states along it, with each 
state representing an increment of 5.625°. Those of ordinary skill in the art will appreciate that other units 
and other levels of discretization can be chosen. In particular, finer discretization will give more accurate 
calculations of movement at the expense of longer calculation time, while coarser discretization will give 
less accurate calculations with a shorter calculation time. 

In order to simplify the example, the front wheels 1205 are assumed to be parallel, and to have three 
possible postions: 45° to the left, straight, and 45° to the right. The wheel positions are used to determine 
how the car 1202 moves, but are not a parameter. of the configuration space in this embodiment. In real 
cars, the wheels may not always be precisely parallel. However, given the level of discretization chosen, 
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such seconday effects can be ignored. In real cars, the front wheels can assume a greater variety of 
positions than are allowed in the present example. The techniques of the present example can be readily 
adjusted to take into account secondary effects and increased numbers of wheel angels. 

Figure 13 schematically illustrates the shape of transform of the neighbourhood of any given car pose 

5 as that transform would look in task space. Assuming the front of the car is pointed towards dir 3. Fiber 
1351 illustrates the forward and 1350 the backward path of the Cartesian point location of the car when the 
front wheels are turned 45° to the left. Fiber 1361 illustrates the forward and 1360 the backward path of the 
Cartesian point location of the car with the front wheels turned 45° to the right. Fiber 1371 illustrates the 
forward and 1370 the backward path of the Cartesian point location of the car with the front wheels straight. 

w When a real car drives first forward and then backward, with the steering wheel turned at a given angle, 
the real car does not exactly retrace its path. However, because of the discretization of the configuration 
space, the paths 1350, 1351. 1360, 1361, 1371, and 1370 adequately represent the possible paths of the 
car given the assumed front wheel angels. If the discretization gives rise to rounding errors, with the car 
ending tip in a pose other than that intended, the car can still follow the direction__arrows from its new pose 

75 to the goal. 

If it is assumed that the maximum angle which the front wheels can make is 45°. the fibers 1350/1351 
and 1360/1361 define outer boundaries of all of the possible paths which the Cartesian point location of the 
car can take from the given pose. The shape of Figure 13 will be referred to herein as a "bow-tie". Thus the 
set of neighbours of a given state in configuration space, will correspond to a bow-tie around the pose 

20 corresponding to that state in task space. 

The bow-tie formation illustrates the usefulness of choosing the Cartesian point location of the car in 
task space to be midway between the non-steering wheels. This Cartesian point location is a pivot point of 
the car. In other words, when this Cartesian point location is chosen, fibers 1350 and 1360 meet at a single 
tangent point, rather than having two points of intersection. 

25 Other kinds of vehicles may have more or different pivot points. 

Figure 13 schematically illustrates the location of 24 neighbour points surrounding an arbitrary point in 
task space. It is to be noted that since budding generally occurs outward from the goal, the lines,, from the 
current pose are opposite to the direction_arrows which would be assigned during budding. Thus 
neighbour dir 7, which is forward of the current position and to the left, corresponds to a direction^ arrows 

30 value which corresponds to moving the car backwards with the front wheels turned left. Neighbour dir 19, 
which is in back of the current position and to the left, corresponds to a direction^ arrows value which 
corresponds to moving the car forwards with the front wheels turned all the way to the left. 

The neighbour points of Figure 13 are adapted to the particular discretization which was chosen for this 
example. More neighbours would allow for more precise movement Less neighbouts would allow for less 

35 precise movement. If the wheels of the car are allowed to assume more angles, i.e. if they are represented 
with a finer degree of discretization, the bow-tie will have more fibers with neighbours on each fiber. 
Alternatively, enough neighbours can be added to completely fill the space between the outerboundary 
fibers 1350/1351 and 1360/1361. These additional neighbours may or may not be considered to be located 
on fibers, although they correspond to some calculable and unique wheel angle. These additional 

40 neighbours will minimize transition cost to the current state. In such a case, the wheel angel could be 
considered to be continuous rather than discretized. 

The above discussion of neighbourhoods can be generalized to other examples of path planning. In 
general, the number of neighbours to a current state can vary depending on the state. In other words, tile 
neighbourhood is "space- variant". In addition, the neighbourhood around the state can take on any shape 

45 depending on the application. 

The placement of these 24 neighbour poses with respect to the current pose are listed in TABLE 1 . As 
shown in this table, the neigbhour points are a function of the angle <f> of the car. The angle <*> is called 

"carangie" in the table, and it assumes values 0-64. The neighbour poses are called dir 0, dir 1 dir 23. 

which correspond to the neigbhour points in Figure 13. Next to the name of each of the neighbour points in 

so TABLE I are four numbers. The first number represents a distance travelled by the Cartesian point location 
of the car from a current point to the neighbour point. The next three points represent the pose differential 
value (dx.dy,d</>), with dx. dy, and d4> represented as respective numbers of states. 

Thus, for example, under carangie 0 in TABLE I, dir 0 represents a Cartesian point location movement 
of 0.250 units, a transition of one state in the x direction, and a transition of zero states in the y and <*> 

55 directions. Similarly, under carangie 0, we see that dir 23 represents a Cartesian point location movement of 
1.017, a transition of -4 states in the x direction, a transition of 0 states in the y direction, and a transition of 
3 states in the <t> direction. 

Within a given carangie, two neighbour points may not be distinguishable. For instance, under carangie 
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0, dir 4 represents a Cartesian point location movement of 0.250, a transition of one state in the x direction 
and transitions of zero states in the y and <f> directions. Thus under carangle 0, dir 4 is indistinguishable 
from dir 0. This is an artifact resulting from the level of discretization of the configuration space. The 
transition with the higher cost will never be chosen in box 19 of Figure 1a. In in alternative embodiment, this 
5 redundancy of the neighbourhood can be eliminated, by removing higher cost redundant neighbours from 
the search. 

Thus, in general, Table I defines a set of neighbourhoods which vary according to the state, or a "space 
variant neighbourhood". 

The cost function chosen to be minimized in this embodiment is the distance travelled by the Cartesian 
io point location of the car. Because of this choice of cost function, the distance values in TABLE I also 
indicate the transition costs from the states corresponding to the indicated neighbour poses to the state 
corresponding to the indiated current pose. TABLE I thus also defines a space variant metric as well as a 
space variant neighbourhood. The term "metric" is applied to the metric induced herein to mean that 
transition costs are > 0, regardless of whether there is symmetry of transition costs or whether the triangular 
is inequality holds for transition costs. 

One skilled in the art might choose other cost functions to minimize, for instance the number of turns of 
the steering wheel, or the amount of time a particular path takes to follow. 

If different parameters were chosen for the configuration space the set of neighbours would be chosen 
differently. For instance, the bow-tie of Figure 13 is symmetrical because it is assumed that the car has 
20 perfect response. If the car does not have perfect response, velocity may become a fourth parameter of the 
configuration space. At higher velocities, it is not reasonable to consider instantaneously reversing the 
direction of the car. Therefore, some of the neighbourhoods will have a transform looking like a narrowed 
version of only one bow of the bow-tie. For instance, if the car is moving 30 m.p.h. forward, dir 0 through dir 
11, which correspond to reverse motion of the car, should be eliminated from the neighbourhood. Similarly, 
25 the maximum wheel angles allowed at 30 m.p.h. would be smaller than those allowed at rest, therefore dir 
16 through dir 19 would correspond to a maximum wheel angle of less than 45°. In this example, extra 
neighbours, beyond dir 15, dir 19, and dir 20 should be added to correspond to extra possibilities for motion 
for the car. 

In budding, the neighbours in the bow-tie neighbourhood must be searched according to a precedence, 
30 as described in section D, above, in which no neighbour is searched if it is beyond a neighbour which is 
blocked by an obstacle. In the case of Figure 12, the precedence can involve searching all of the 
neighbours on a fiber of the bow-tie, from the center out, until an obstacle is reached or until the end of the 
fiber, and then searching another fiber. Other precedences can be chosen. For instance, if redundant 
neighbours are removed, the removed redundant neighbour should be considered blocked or non-blocked 
35 for precedence of search depending on whether a retained redundant state is blocked. In other words, if dir 
4 is removed from Table I for the search for carangle 0, then the search of block 17 of Figure 1b will search 
dir 5 if and only if dir 0 is non-blocked. 

The transformation of obstacles into configuration space will now be described. 

The obstacles 1203 and 1204 will have different shapes in configuration space depending on the angle 
40 <f> of the car 1201. Figures 14 a, b, c, and d, illustrate <f> planes of the configuration space showing obstacle 
regions for obstacles similar to 1203 and 1204. 

Figure 14a shows the £ = 180° plane of the configuration space. The car is illustrated schematically at 
1401a, where it is pictured at the angle <#» = 180°. Regions 1402a correspond to the size of real obstacles in 
task space. Regions 1403a correspond to additional space which the Cartesian point location of the car 
45 cannot enter because of the surface area covered by the car. Regions 1404a correspond to areas which the 
Cartesian point location of the car cannot enter because of selected boundaries of the task space, for 
instance curbs on a road. Region 1405a represents the area in which the Cartesian point location of the car 
is free to move. Figures 14b-14d illustrate the same configuration space as Figure 14a, but in the <*> = 90°, 
270°, and 235° planes, respectively. 
so Figure 15 is a screen image of a sun workstation running of a simulation. The screen image shows a 
superposition of images of the car 1202 as it moves through the poses associated with states along a path 
which parallel parks the car. Obstacles 1503 represent parked cars. The path followed by the rear wheels is 
marked 1501. The pivot point at the rear differential moves along 1502. 1504 marks the front of the car. 

55 
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dir s diet dx dy d* 
carangle 0 

5 dir 0: 0.250 1 0 0 dir It 0.500 2 0 0 dir 2: 0.75h 3 n 0 

dir 3: 1.000 4 0 0 dir 4 : 0.250 1 0 0 dir 5: 0.502 2 0 1 

dir 6: 0.757 3 0 2 dir 7: 1.017 4 0 3 dir 8: 0.250 1 0 0 

dir 9: 0.502 2 0 -1 dir 10: 0.757 3 0 -2 dir 11: 1.017 4 0 -3 

dir 12: 0.250 -1 0 0 dir 13 : 0.500 -2 0 0 dir 14: 0.750 -3 0 0 

dir 15: 1.000 -4 0 0 dir 16: 0.250 -1 0 0 dir 17: 0.502 -2 0 -1 

dir 18: 0.757 -3 0 -2 dir 19: 1.017 -4 0 -3 dir 20 : 0.250 -1 0 0 

dir 21: 0.502 -2 0 1 jiir 22! 0.757 -3 0 2 dir 23: 1.017 -4 0 3 

70 ""Sir* 0: 0.250 0 0 0 dir 1:0.500 1 0 0 dir 2: 0.750 2 0 0 

dir 3: 1.000 3 0 0 dir 4: 0.250 0 0 0 dir 5: 0.502 1 0 1 

dir 6: 0.757 2 0 2 dir 7: 1.017 3 0 3 dir 8: 0.250 0 0 0 

dir 9: 0.502 1 0 -1 dir 10: 0.757 2 0 -2 dir 11: 1.017 4 0 -3 

dir 12: 0.250 0 0 0 dir 13: 0.500 -1 0 0 dir 14: 0.750 -2 0 0 

dir 15: 1.000 -3 0 0 dir 16: 0.250 0 0 0 dir 17: 0.502 -1 0 -1 

dir 18: 0.757 -2 0 -2 dir 19: 1.017 -4 0-3 dir 20: 0.250 0 0 0 

dir 21: 0.502 -1 0 1 dir 22 : 0.757 -2 0 2 dir 23: 1.017 -3 0 3 
15 carangle 2 

dir 0: 0.250 0 0 0 dir 1: 0.500 '10 0 dir 2: 0.750 2 0 0 

dir 3: 1.000 3 0 0 dir 4: 0.250 0 0 0 dir 5: 0.502 1 0 1 

dir 6: 0.757 2 0 2 dir 7: 1.017 3 13 dir 8: 0.250 0 0 0 

dir 9: 0.502 1 0 -1 dir 10: 0.757 2 0 -2 dir 11: 1.017 3 0 -3 

dir 12: 0.250 0 0 0 dir 13: 0.500 -1 0 0 dir 14: 0.750 -2 0 0 

dir 15: 1.000 -3 0 0 dir 16: 0.250 0 0 0 dir 17 : 0.502 -1 0 -1 

dir 18: 0.757 -2 0 -2 dir 19: 1.017 -3 0 -3 dir 20: 0.250 0 0 0 

dir 21: 0.502 -1 0 1 dir 22 : 0.757 -2 0 2 dir 23: 1.017 -3 -1 3 
carangle 3 

dir 0: 0.250 0 0 0 dir 1: 0.500 1 0 0 dir 2: 0.750 2 0 0 

dir 3: 1.000 3 1 0 dir 4: 0.250 0 0 0 dir 5: 0,502 1 0 1 

dir 6: 0.757 2 0 2 dir 7: 1.017 3 13 dir 8: 0.250 0 0 0 

dir 9: 0,502 1 0 -1 dir 10: 0.757 2 0 -2 dir 11: 1.017 3 0 -3 

dir 12: 0.250 0 0 0 dir 13 : 0.500 -1 0 0 dir Mt 0.750 -2 0 0 

dir 15: 1.000 -3 -1 0 dir 16: 0.250 0 0 0 dir 17: 0.502 -1 0 -1 

dir 18: 0.757 -2 0 -2 dir 19: 1.017 -3 0 -3 dir 20 : 0.250 0 0 0 

25 dir 21: 0.502 -1 0 1 dir 22 : 0.757 -2 0 2 dir 23s 1.017 -3 -1 3 
carangle 4 

dir 0: 0.250 0 0 0 dir 1: 0.500 1 0 0 dir 2: 0.750 2 1 0 

dir 3: 1.000 3 1 0 dir 4: 0.250 0 0 0 dir 5: 0.502 1 0 1 

dir 6: 0.757 2 1 2 dir 7: 1.017 3 13 dir 8: 0.250 0 0 0 

dir 9: 0.502 1 0 -1 dir 10: 0.757 2 1 -2 dir 11: 1.017 3 1 -3 

dir 12: 0.250 0 0 0 dir 13: 0.500 -1 0 0 dir 14: 0.750 -2 -1 0 

dir 15i 1.000 -3 -1 0 dir 16: 0.250 0 0 0 dir 17 : 0.502 -1 0 -1 

30 dir 18: 0.757 -2 -1 -2 dir 19: 1.017 -3 -1 -3 dir 20: 0.250 0 0 0 

dir 21: 0.502 -1 0 T dir 22 : 0.757 -2 -1 2 dir 23: 1.017 -3-1 3 
carangle 5 

dir 0: 0.250 0 0 0 dir 1: 0.5O0 10 0 dir 2: 0.750 2 1 0 

dir 3: 1.000 3 1 0 dir 4: 0.250 0 0 0 dir 5: 0.502 1 0 1 

dir 6: 0.757 2 1 2 dir 7: 1.017 3 2 3 dir 8: 0.250 0 0 0 

dir 9: 0.502 1 0 -1 dir 10: 0.757 2 1 -2 dir 11: 1.017 3 1 -3 

dir 12: 0.250 0 0 0 dir 13: 0.500 -1 0 0 dir 14: 0.750 -2 -t 0 

3S dir 15: 1.000 -3 -1 0 dir 16: 0.250 0 0 0 dir 17: 0.502 -1 0 -1 

dir 18: 0.757 -2 -1 -2 dir 19: 1.017 -3 -1 -3 dir 20 : 0.250 0 0 0 

dir 21: 0.502 -1 0 1 dir 22: 0.757 -2 -1 2 dir 23: 1.017 -3-2 3 
carangle 6 

dir 0: 0.250 0 0 0 dir 1: 0.500 1 1 0 dir 2: 0.750 2 I 0 

dir 3: 1.000 3 2 0 dir 4: 0.250 0 0 0 dir 5: 0.502 1 1 1 

dir 6: 0.757 2 1 2 dir 7: 1.017 3 2 3 dir 8: 0.250 0 0 0 

dir 9: 0.502 1 1 -1 dir 10: 0.757 2 1 -2 dir 11: 1.017 3 2 -3 

dir 12: 0.250 0 0 0 dir 13 : 0.500 -1 -1 0 dir 14: 0.750 -2 -1 0 

40 dir 15: 1.000 -3 -2 0 dir 16: 0.250 0 0 0 dir 17: 0.502 -1 -1 -1 

dir 18: 0.757 -2 -1 -2 dir 19; 1.017 -3 -2 -3 dir 20: 0.250 0 0 0 

dir 21: 0.502 -1 -1 1 dir 22: 0.757 -2 -1 2 dir 23: 1.017 -3 -2 3 

carangle 7^ ^ ^ o 0 0 dir 1: 0.500 1 1 0 dir 2: 0.750 2 1 0 

dir 3: 1.000 3 2 0 dir 4: 0.250 0 0 0 dir 5: 0.502 1 I 1 

dir 6: 0.757 2 1 2 dir 7: 1.017 2 2 3 dir 8 : 0.250 0 0 0 

dir 9: 0.502 1 1 -1 dir 10: 0.757 2 1 -2 dir lh 1.017 3 2 -3 

45 dir 12: 0.250 0 0 0 dir 13: 0.500 -1 -1 0 dir 14: 0.750 -2 -1 0 

dir 15: 1.000 -3 -2 0 dir 16: 0.250 0 0 0 dir 17 : 0.502 -1 -I -1 

dir 18: 0.757 -2 -1 -2 dir 19: 1.017 -3 -2 -3 dir 20: 0.250 0 0 0 

dir 21: 0.502 -1 -1 1 dir 22: 0.757 -2 -1 2 dir 23: 1.017 -2 -2 3 
caranqle 8 

dir 0: 0.250 0 0 0 dir 1: 0.500 1 1 0 dir 2: 0,750 2 2 0 

dir 3: 1.000 2 2 0 dir 4 : 0.250 0 0 0 dir 5: 0.502 1 I 1 

dir 6: 0.757 2 2 2 dir 7: 1.017 2 3 3 dir 8: 0.250 0 0 0 

dir 9: 0.502 1 1 -1 dir 10: 0.757 2 2 -2 dir 11: 1.017 3 2 -3 

dir 12: 0.250 0 0 0 dir 13 : 0.500 -1 -1 0 dir 14: 0.75O -2 -2 0 

dir 15: 1.000 -2 -2 0 dir 16 : 0.250 0 0 0 dir 17: 0.502 -1 -1 -1 

dir*18: 0.757 -2 -2 -2 dir 19: 1.017 -3 -2 -3 dir 20: 0.250 0 0 0 

dir 21: 0.502 -1 -1 1 dir 22: 0.757 -2 -2 2 dir 23: 1.017 -2 -3 3 
caranqle 9 

dir 0: 0.250 0 0 0 dir Is Q.S00 110 dir 2: 0.750 1 2 0 

dir 3: 1.000 2 3 0 dir 4 : 0.250 0 0 0 dir 5: 0.502 1 1 1 

55 dir 6: 0.757 1 2 2 dir 7: 1.017 2 3 3 dir 8: 0.250 0 0 0 
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dir 9: 0.502 1 I -1 dir 10: 0.757 1 2 -2 dir 11: 1.017 2 2 -3 

5 dir 12: 0.250 0 0 0 dir 13: 0.500 -1 -1 0 dir 14 0 750 -1 -2 0 

dir 15: 1.000 -2 -3 0 dir 16: 0.250 0 0 0 Sir 7 0 502 - -1 -1 

dir 18: 0.757 -1 -2 -2 dir 19: 1.017 -2 -2 -3 dir 20 0 250 0 0 0 

dir 21: 0.502 -1 -1 1 dir 22: 0.757 -1 -2 2 dir & \ f\l -2 -3 3 
carangle 10 

dir 0: 0.250 0 0 0 dir 1:0.500 1 1 0 dir 2* 0 750 1 2 0 

dir 3: 1.000 2 3 0 dir 4: 0.250 0 0 0 dir £ 0 502 1 1 1 

2! r S ! 2*£? ! ? ? i\ T 7: l * 017 2 3 3 d r I 0:250 000 

dir 9: 0.502 1 1 -1 dir 0: 0.757 1 2 -2 dir 11 1 017 2 3 -3 

10 dir 12 : 0.250 0 0 0 dir 13: 0.500 - -I 0 dir 14- 0 750 -1 -2 0 

dir 15: 1.000 -2 -3 0 dir 16: 0.250 0 0 0 Sir 17 0 502 - -1 -1 

dir 18: 0.757 -1 -2 -2 dir 19: 1.017 -2 -3 -3 dir 20 0 250 0 0 0 

dir 21: 0.502 -1 -1 1 dir 22: 0.757 -1 -2 2 dir 23 1 01 7 -2 -3 3 
carangle 11 

dir 0: 0.250 0 0 0 dir 1: 0.500 0 1 0 dir 2: 0.750 1 2 0 

dir 3: 1.000 1 3 0 dir 4 : 0.250 . 0 0 0 dir 5: 0.502 Oil 

$ r £ 2*252 A ? ? dir 7: 1017 133 d ^ * 0 250 0 0 0 

75 dir 9: 0.502 0 1 -1 dir 10: 0.757 1 2 -2 dir 11: 1.017 2 3 -3 

dir 12 : 0.250 0 0 0 dir 13: 0,500 .0 -1 0 dir 14: 0.750 -1 -2 0 

dir 15: 1.000 -1 -3 0 dir 16: 0.250 0 0 0 dir 17: 0.502 0 -1 -1 

dir 18: 0.757 -1 -2 -2 dir 19: 1.017 -2 -3 -3 dir 20 0 250 0 0 0 

dir 21: 0.502 0 -1 1 dir 22: 0.757 -1 -2 2 dir & 1 017 -1 -3 3 
carangle 12 

dir 0: 0.250 0 0 0 dir 1: 0.500 0 1 0 dir 2: 0.750 1 2 0 

2} r 2 ! A*2!3 ! 3 0 dir 4s °- 250 o o o dir 5: 0.502 0 1 1 

20 H r *' 2*252 12 2 dir 7: 1.017 13 3 dir 8: 0,250 0 0 0 

3* r ,! : 2-522 2 A "i H T }?* S-Z 57 1 2 * 2 di <" 1.017 i 3 -3 

du 12: 0.250 0 0 0 dir 13: 0.500 0 -1 0 dir 14: 0,750 -1 -2 0 

i\* W A-222 i *2 9 d * r 16t °- 250 0 0 0 dir 17s °-so2 o -i -i 

dir 18: 0.757 -1 -2 -2 dir 19: 1.017 -1 -3 -3 dir 20: 0.250 0 0 0 

dir 21: 0.502 0 -1 1 dir 22 : 0.757 -1 -2 2 dir 23: 1.017 -1 -3 3 
carangle 13 

dir 0: 0.250 0 0 0 dir 1: 0.500 0 1 0 dir 2: 0.750 0 2 0 

2<5 Jir 3: 1.000 1 3 0 dir 4 : 0.250 0 0 0 dir 5: 0.502 0 1 1 

25 dir 6: 0.757 0 2 2 dir 7: 1.017 0 3 3 dir 8: 0.250 0 0 0 

dir 9: 0.502 0 1 -1 dir 10: 0,757 0 2 -2 dir 11: 1.017 1 3 -3 

dir 12: 0.250 0 0 0 dir 13: 0.500 0 -I 0 dir 14: 0.750 0 -2 0 

S? r }l : A*22? "A ~2 2 dir 16: °- 250 0 0 0 dir H: 0.502 0 -1 -1 

3* r if ! 2-2S 2 '? "? St r 12 ! 1017 "3 ~ 3 dir 20 : 0.250 0 0 0 

dir 21: 0.502 0 -1 1 dir 22 : 0.757 0 -2 2 dir 23: 1.017 0 -3 3 
carangle 14 

dir 0: 0.250 0 0 0 dir 1: 0.500 0 1 0 dir 2 : 0.750 0 2 0 

30 dir 3: 1.000 0 3 0 dir 4 : 0.250 0 0 0 dir 5: 0.502 0 1 1 

3* r t' 2-2S2 2 ? ? £ r . 7 * 1 017 0 3 3 dir 8: 0.250 0 0 0 

2l r , 2*2*522 2 A "A dir 0: 0.757 0 2 -2 dir 11: 1.017 1 3-3 

dir 12: 0.250 0 0 0 dir 13: O.SOO 0-10 dir 14: 0.750 0 -2 0 

5i r }f s A'929 2 "2 0 dir l6s °- 250 0 0 0 d " 0-502 0 -1 -1 

2' r Jf : 2-252 2 i i i\ T I9s ^o 17 - 1 - 3 - 3 dl f 20: 0.250 000 

dir 21: 0.502 0 -1 1 dir 22: 0.757 0 -2 2 dir 23: 1.017 0 -3 3 
carangle lb 

35 d ?r 2* ?.250 0 0 0 dir 1« 0.500 0 1 0 dir 2: 0.750 0 2 0 

2* r 2 s A-S22 2 2 2 dir 4: °' 250 0 0 0 ^ 0.502 0 1 1 

$ r S : 2*52 2 ? ? dir 7; i- 017 043 dir * j o-25o 000 

S* r i2 s 2-522 2 A "A dir 101 °- 757 0 2 - 2 dir n« 1-017 03-3 

dir 12: 0.250 0 0 0 dir 13: 0.500 0 -1 0 dir 14: 0.750 0 -2 0 

2? r J5* A-229 2 "2 2 3 ir J 6 * °- 250 0 0 0 dir "« 0.502 0 -1 -1 

l? : 2*252 2 i "? ^ r l 9: ^o 17 0 * 3 - 3 dir 20 * 0.250 000 

dir 21: 0.502 0 -1 1 dir 22: 0.757 0 -2 2 dir 23: 1.017 0 -4 3 
An carangle lo 

° dir 0: 0.250 0 1 0 dir 1: 0.500 0 2 0 dir 2 : 0.750 0 3 0 

2} r 2 : A-222 2 i 2 £ r At °* 250 0 1 0 dip 5: o- 502 o 2 1 

!$! r §*• 2*252 2 2? dlr 7j ^o 17 0 4 3 d * r *■ 0.250 0 1 0 

l ir ,2 : 2*522 2 ? "A ^ r 10: °« 757 0 3 - 2 dir i-on 0 4 -3 

2! r }2 S ?*252 2 i 2 l u 13: °- 500 °-2 0 dir 14: 0.750 0 -3 0 

?? r }5 ! i'222 2 " 4 0 dir 16: °- 250 0 -1 0 dir 17: 0.502 0 -2 -1 

dir 18: 0.757 0 -3 -2 dir 19: 1.017 0-4-3 dir 20 : 0.250 0 -1 0 

dir 21: 0.502 0 -2 1 dir 22 : 0.757 0 -3 2 dir 23: 1.017 0 -4 3 
<S carangle 17 

dir 0: 0.250 0 0 0 dir 1: 0.500 0 1 0 dir 2: 0.750 0 2 0 

dir 3: 1.000 0 3 0 dir 4 : 0.250 0 0 0 dir 5: 0.502 0 1 1 

dir 6: 0.757 0 2 2 dir 7: 1.017 0 3 3 dir 8: 0.250 0 0 0 

dir 9: 0.502 0 1 -1 dir 10: 0.757 0 2 -2 dir 111 K017 0 4 -3 

^ r II' 9*252 2 2 2 5i r W 2-595 0 -i o dir 14* 0.750 0-20 

dir 15: 1.000 0 -3 0 dir 16: 0.250 0 0 0 dir 17: 0.502 0 -1 -1 

dir 18: 0.757 0 -2 -2 dir 19: 1.017 0 -4 -3 dir 20: 0.250 0 0 0 

50 dir 21: 0.502 0 -1 1 dir 22: 0.757 0 -2 2 dir 23: 1.017 0 -3 3 
carangle 18 

dir 0: 0.250 0 0 0 dir 1: 0.500 0 1 0 dir 2: 0.750 0 2 0 

dir 3: 1.000 0 3 0 dir 4 : 0.250 0 0 0 d r 5 0 502 0 1 1 

dir 6: 0.757 0 2 2 dir 7: 1.017 -1 3 3 d r 8 0 250 0 0 0 

dir 9: 0.502 0 1 -1 dir 10: 0.757 0 2 -2 d r 11 1 017 0 3 -3 

dir 12 : 0.250 0 0 0 dir 13: 0.500 0 -1 0 dir 14 0 750 0 -2 0 

dir 15: 1.000 0 -3 0 dir 16 : 0.250 0 0 0 d r 17 0 502 0 -1 -1 

« dir 18: 0.757 0 -2 -2 dir 19: 1.017 0-3-3 Sir 20 0 250 0 0 0 

55 dir 21: 0.502 0 -1 1 dir 22 : 0.757 0 -2 2 d r 23 1 017 1 -3 3 
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1/VDLL 1 



carangle 19 

dir 0: 0.250 
dir 3: K00O 
dlr 6: 0.757 
dir 9: 0,502 
dlr 12: 0.250 
dir 15: 1.000 
dlr 18: 0.757 
dir 21: 0.502 
carangle 20 

dir 0: 0.250 
dlr 3: 1.000 
dir 6: 0.757 - 
dir 9: 0.502 
dir 12: 0.250 
dlr 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 21 

dir 0: 0.250 
dir 3: 1.000 - 
dlr 6: 0.757 « 
dlr 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 22 
dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 23 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 24 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 25 

dlr 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dlr 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 26 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12; 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 27 
dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 

dir lBi 2-251 

dir 21: 0.502 
carangle 28 _ m 
dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 



0 0 0 
13 0 
0 2 2 
0 1 -1 

0 0 0 

1 -3 0 
0 -2 -2 
0-1 1 

0 0 0 
•13 0 
•12 2 
0 1 -1 

0 0 0 

1 -3 0 
1 -2 -2 
0 -1 1 



0 0 0 

1 3 0 
1 2 2 
0 1 -1 

0 0 0 

1 -3 0 
1 -2 -2 
0 -1 1 



0 0 0 
2 3 0 
12 2 

1 1 -1 

0 0 0 
2-3 0 

1 -2 -2 
1 -1 1 



0 0 0 

2 3 0 

12 2 

•1 1 -1 

0 0 0 
2-3 0 

1 -2 -2 
1-1 1 



0 0 0 
-2 2 0 
•2 2 2 
-1 1 -1 

0 0 0 
2-2 0 
2 -2 -2 

1 -1 1 



dir 1: 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 



0 0 
2 0 

1 2 
1 -1 
0 0 
-2 0 

2 -1 -2 

1 -1 1 

0 0 0 
-3 2 0 
-2 1 2 
-1 1 -1 

0 0 0 
3-2 0 

2 -1 -2 

1 -1 1 

0 0 0 
-3 1 0 
-2 1 2 
-1 0-1 

0 0 0 
3-10 

2 -1 -2 

1 0 1 



dir 1: 
dir 4: 
dir 7: 
dir 10: 
dir 13: 



-2 1 
-1 0 



0.500 
0.250 
1.017 
0.757 
0.500 



dir 1: 

dir 4: 

dir 7: 

dir 10: 

dir 13: 

dir 16: 

dir 19: 

dir 22: 



1 0 
0 0 
3 3 

2 -2 
-1 0 

0 0 
0 -3 -3 
0 -2 2 



dir 16: 0.250 
dlr 19: 1.017 
dir 22: 0.757 

dir 1: 0;5O0 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 

dir 1: 0.500 
dir 4: 0.250 
dir 6: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 

dir 1: 0.500 

dir 4: 0.250 

dir 7: 1.017 

dir 10: 0.757 

dir 13: 0.500 

dir 16: 0.250 

dir 19: 1.017 

dir 22: 0.757 



1 0 

0 0 
3 3 

2 -2 

1 0 
0 0 

1 -3 -3 
1 -2 2 



0 .1 0 
0 0 0 
-2 3 3 
-1 2 -2 
0-10 

0 0 0 

1 -3 -3 
1 -2 2 



-1 1 

0 0 
-2 3 
-1 2 

1 -1 

0 0 

2 -3 -3 

1 -2 2 



-1 I 

0 0 
-2 2 
-1 2 

1 -I 

0 0 

2 -3 -3 

1 -2 2 



0.500 
0.250 
1.017 
0.757 
0.500 
0.250 
1.017 
0.757 



-1 1 

0 0 
-3 2 
-2 2 

1 -1 
0 0 

2 -3 -3 
2-2 2 



dir 1: 0.500 

dir 4: 0.250 

dir 6: 1.017 

dir 10: 0.757 

dir 13: 0.500 

dir 16: 0.250 

dir 19: 1.017 

dir 22: 0.757 

dir h 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 

dir 1: 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 

dir 1: 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.7S7 



-1 1 

0 0 
-3 2 
-2 1 

1 -1 
0 0 

2 -2 -3 
2 -1 2 



dir 2: 0.750 
dir 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
dir 20: 0.250 
dir 23: 1.017 

dir 2: 0.750 
dlr 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
dlr 20: 0.250 
dir 23: 1.017 

dir 2: 0.750 
dir 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
dir 20: 0.250 
dir 23: 1.017 



-1 1 

0 0 
-3 2 
-2 

1 -1 
0 0 
3 -2 -3 
2-12 



•10 0 

0 0 0 
-3 1 3 
-2 i -2 

1 0 0 
0 0 0 
3 -2 -3 
2-12 



-1 0 

0 0 

-3 1 

-2 1 



0 2 0 

01 • 
0 C 0 
0 3-3 
0-2 0 
0 -1 -1 

0 0 0 

1 -3 3 

-12 0 

0 1 1 

0 0 0 
-1 3 -3 

1 -2 0 
0-1 -1 

00 0 

1 -3 3 

-1 2 0 

0 1 1 

0 0 0 
-1 3 -3 

1 -2 0 
0 -1 -1 
0 0 0 
2-3 3 



dir 2: 

dir 5: 

dir 8: 

dir 11: 

dir 14: 

dir 17: 

dir 20: 

dir 23: 



0.750 
0.502 
0.250 
1.017 
0.750 
0.502 
0.250 
1.017 



-12 0 
-1 1 1 

0 0 0 
-2 3 -3 

1 -2 0 
1 -1 -1 
0 0 0 
2-3 3 



dlr 2: 0.750 

dir 5: 0.502 

dir 8: 0.250 

dir 11: 1.017 

dir 14: 0.750 

dir 17: 0.502 

dir 20: 0.250 

dir 23: 1.017 

dir 2: 0.750 

dir 5: 0.502 

dir 8: 0.250 

dir 11: 1.017 

dir 14: 0.750 

dir 17: 0.502 

dir 20: 0.250 

dir 23: 1.017 

dir 2: O.750 
dir 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 
dir 17: 
dir 20: 
dir 23 



0.750 
0.502 
0.250 
1.017 



dir 2: 0.750 
dir 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
dir 20: 0.250 
dir 23: 1.017 

dlr 2: 0.750 
dir 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
- dir 20: 0.250 
dir 23: 1.017 

dlr 2: 0.750 

dir 5: 0.502 

dir 8: 0.250 

dir Hi 1.017 



1 2 0 

1 1 1 

0 0 0 

2 3 -3 

1 -2 0 

1 -1 -1 
0 0 0 

2 -2 3 



-2 2 0 
-1 1 1 

0 0 0 
-2 3 -3 

2- 2 0 

1 -1 -1 
0 0 0 

3- 2 3 

-2 1 0 

-1 1 1 

0 0 0 
-2 2 -3 

2- 10 

1 -1 -1 
0 0 0 

3- 2 3 

-2 1 0 

-1 1 1 

0 0 0 
-3 2 -3 

2- 10 

1 -1 -1 
0 0 0 

3- 2 3 

-2 1 0 

-1 0 1 

0 0 0 
-3 2 -3 

2- 10 

1 0-1 
0 0 0 

3- 13 

-2 1 0 

-1 0 1 

0 0 0 

-3 1 -3 
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dir 15: 1.000 3 -1 0 dir 16: 0.250 0 0 0 d j? n«;r} - A ? 
die 18: 0.757 2 -1 -2 dir 19: J 017 3 -1 -3 d r 2 §1" 6 0 1 

cackle «°- 502 1 ° 1 dir22j °- 757 2-1 2 dir' £ ftl? J.? J 

? : ?*^2 ? 9 0 dir 1:0.500 -1 0 0 dir 2 - 0 750 -2 0 0 

5} r 2 s i-299 "IAS <Jir 4: 0.250 0 0 0 d l 0 502 I? 0 1 

5J r S : 2*2£ *? 2 ? dir 7 ' 1.0" -3 0 3 d 8- 0 250 0 0 0 

dir 9: 0.502 -1 0 -1 dir 10: 0 757 -2 0 -2 Air n i nvi 2 ? ? 

dir 12: 0.250 0 0 0 Sir 3 0 500 1 0 0 1 o'?in 1 A "2 

dir 15: 1.000 3 -1 0 dir 16: 0 250 0 0 0 d r 0*502 1 0 -1 

5? r J? : 2' EE ? 2 "? dir 19: 1-017 3 -1 -3 d r 20 0 2S0 0 0 0 

ca«ngle 2 30 0,502 1 ° 1 dir 22: °' 757 2 0 2 * 3 0 3 

dir 0: 0.250 0 0 0 dir 1:0.500 -1 0 0 dir ?• o «n n n 

2 : A*S£ i 2 0 dlr * ! 0 250 0 0 0 d \l \\ 0 502 -1 0 1 

2} r 5 s 2-252 i 2 ? dir 7j i-on -303 S r a 0 250 0 0 0 

dir 9: 0.502 -1 0 -1 dir 10: 0.757 -2 0 -2 dir 11 inn * i ? 

dir 12: 0.250 0 0 0 dif 13 0 500 1 0 0 d it \\> 0 7 0 1 0 *0 

5* r }5 ! A-92? 3 2 0 dir 16: 0.250 -0 0 0 d r 17 0 502 1 0 -1 

dir 18 : 0.757 2 0 -2 dir 19: 1.017 3 -1 -3 Sir 20 0 250 n n A 

car^leM °' 502 1 0 1 *' 22: 2 0 2 » S U& 3 0 3 

dir 0: 0.250 0 0 0 dir 1:0.500 -1 0 0 dir 1* 0 750 .9 n n 

dir 3: 1.000 -3 0 0 dir 4: 0 250 0 0 0 d r \\ 0 IS ? 2 ? 

dir 6 : 0.757 -2 0 2 dir 7 1 017 -4 0 3 S 0 250 1 0 0 

d lr 5: 0.502 -1 0 -1 dir 10 : 0.757 -2 0 -2 d r lli 1 017 -3 o -2 

? : ?-&2 2 2 2 5J r 13s °- 500 1 0 0 d * u o:?so 2 0 0 

2J r i-222 3 0 0 dir 16: 0.250 0 0 0 dir 17 0 502 1 0 -1 

3}E i? : 2-SI ? 2 -? d J r 19s i ° 17 3 0 -3 S r 20 0:250 0 0 0 

car^gie 2 ^ 0 - 502 1 ° 1 dir 22s 0 ' 757 2 0 2 dir 23: lioi? 4 0 3 

Hi I S s ? ™ "12 2 £ r V °- 500 - 2 0 0 «r 2: 0.750 -3 0 0 

dir 3: 1.000 -4 0 0 dir 4: 0.250 -1 0 0 dir 5* o kn? Jj n 1 

dir 6: 0.757 -3 0 2 dir 7: 1 01 7 -4 0 3 d \r I- 0 250 1 n n 

5^ i? : 8-S 1 2 'A d ^ * -3 0 -2 Sc Hi 1.017 -4 0 -3 

dir 12: 0.250 1 0 0 dir 13: 0.500 2 0 0 dir 14 0 750 Inn 

dir 15: 1.000 4 0 0 dir 16 : 0 250 1 0 0 d r 11- 0 502 2 0 -? 

dir 18: 0.757 3 0 -2 dir 19: 1 017 4 0 -3 d r 20* 0 250 1 n n 

carangfe 2 ^ 0 ' 502 2 ° 1 dir 22: °™ 3 0 2 * S £S 4 0 3 

dir 0: 0.250 0 0 0 dir 1: 0.500 -1 0 0 dir 2: 0.750 -2 0 0 

dir 3: 1.000 -3 0 0 dir 4 : 0.250 0 0 0 dir 5- 0 502 -101 

3 r S ! i 0 2 dir 7s I.«7 -3 0 3 d r 8i 0 250 0 0 0 

dir 9: 0.502 -1 0 -1 dir 10: 0.757 -2 0 -2 Sir 11 1 017 -i n ^ 

dlr 12: 0.250 0 0 0 dir 3 0 500 1 0 0 d il ll 0 750 2 n "n 

# r }l ! A'S22 3 0 0 dir 16x 0 So 0 0 0 d r 7: 0 502 1 0 -1 

^ r i? : Hll ? 2 i d * r i9: 4 0 -3 Sir 20 0i250 0 0 0 

carangle 34 1 dir 22: 0,757 2 0 2 dir 23: l ^ 3 0 3 

dir 0: 0.250 0 0 0 dir 1: 0.500 -1 0 0 dir 2- 0 750 -7 0 n 

dir 3: 1.000 -3 0 0 dir 4: 0.250 0 0 0 d r 5^ 0 502 -1 0 1 

5 r S ! 8'S? 1 2 2 dir 7j *M -3 -1 3 dk 8: O.KO 0 0 0 

^ r i? : 2*52 2 "I 2 "I dir 10j °- 7 5 7 -2 0 -2 dir 11 1 017 -3 0 -3 

h55 ?I : H% 2 2 2 d * r 13: °- 5C0 10 0 d r 4 0 750 2 0 0 

dir 15: 1.000 3 0 0 dir 16: 0.250 0 0 0 dir 17- 0 50? 1 n . 1 

d r 18: 0.757 2 0 -2 dir 19: 1 017 3 0 -3 d r 20^ 0 250 0 0 0 

caraSle 35 101 dir 22: °* 757 2 0 2 ^ l ™ 3 l 3 

H\i 2 : ?'S2 2 ? 2 ^ r V' °- 500 "I 0 0 dir 2: 0.750 -2 0 0 

dir 3: 1.000 -3 -1 0 dir 4 : 0.250 0 0 0 dir 5- 0 502 -101 

dir 6: 0.757 -2 0 2 dir 7: 1 017 -3 -1 3 d r 8- 0 250 0 0 n 

^ r ,? : 'A 2 - 1 dir >0a o:757 -2 0 -2 d r lli 1 017 -3 0 -3 

^ r W ?'S2 2 9 ° dir 13j 0.500 1 O0 dir 4 0 750 2 0 0 

dir 15: 1.000 3 1 0 dir 16: 0.250 0 0 0 dir 17 0 502 1 n 1 

^ r J? ! 2-2S ? 2 " 2 dic & 1 ; 0" 3 0 -3 d r S; O.lso 0 0 0 

carafe 36 ' 101 dir 22s °' 757 2 0 2 d ^ % l l ™ 3 ? 3 

dir 0 : 0.250 0 0 0 dir 1: 0.500 -1 0 0 dir 2. 0 750 -2 -1 ft 

d£ I: Iffi 1 "} ? ^ r ^ 8 0 0 ; «™ : 0 1 

2- r S : •? "i ? d *r 7: 1.017 -3 -1 3 dir 8: 0.250 0 0 0 

dir 9: 0.502 -1 0 -1 dir 10: 0.757 -2 -1 -2 3 r 11 1 017 -3 -1 -3 

dir 12: 0.250 0 0 0 dir 13: O.50O 10 0 d lli O.ISO 2 0 

dir 15: 1.000 3 1 0 dir 16: 0.250 0 0 0 dir 7 - 0 502 1 0 -1 

dijr 1S 2 0.757 2 1-2 dir 19: 1.017 3 1-3 d r 20i SilsO 0 0 0 

cardie 37 dir 22: °* 757 2 1 2 dlr 23$ V '™ 3 " 3 

dir 0: 0.250 0 0 0 dir 1: 0.500 -1 0 0 dir 2: 0.750 -2 -1 0 

dir 3: 1.000 -3 -1 0 dir 4: 0.250 0 0 0 5 0 502 -1 0 1 

dir 6: 0.757 -2 -1 2 dir 7: 1.017 -3 -2 3 dir 8 0 250 0 0 0 

dir 9: 0.502 -1 0 -1 dir 10: 0.757 -2 -1 -2 d r 11 1 017 -3 -1 -3 

dir 12: 0.250 0 0 0 dir 13: 0.500 1 0 0 d r OJSO 2 0 

dir 5: 1.000 3 1 0 dir 16: 0.250 0 0 0 dlr 0 502 1 0 -1 

dir 18: 0.757 2 1 -2 dir 19: 1.017 3 1 -3 dir 20: 0 250 0 0 0 

carangl 38 1 ° 1 dlr 225 °- 757 2 1 2 dir 23: 1 017 3 2 3 
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dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
car angle 39 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir IS: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 40 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 41 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 42 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 43 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 44 
dir 0: 0,250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 45 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 46 

dir 0: 0.250 
dir 3: 1.000 
dir e: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 47 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 



0 0 

•3 -2 

•2 -1 

•1 -1 

0 0 
3 2 
2 1 

1 1 



0 0 0 
-3 -2 0 
-2 -1 2 
-1 -1 -1 

0 0 0 
3 2 0 
2 1 -2 

1 1 1 

0 0 0 
-2 -2 0 
-2-2 2 
-1 -1 -1 

0 0 0 

2 2 0 
2 2-2 

1 1 1 

0 0 0 
-2 -3 0 
-1 -2 2 
-1 -1 -1 

0 0 0 

2 3 0 

1 2 -2 

1 1 1 

0 0 0 
-2 -3 0 
-1 -2 2 
-1 -1 -1 

0 0 0 

2 3 0 

1 2-2 
1 1 1 

0 0 0 
-1 -3 0 
-1 -2 2 
0 -1 -1 

0 0 0 

1 3 0 
1 2-2 
0 1 1 

0 0 0 
•1 -3 0 
-1 -2 2 
0 -1 -1 

0 0 0 

1 3 0 
1 2 -2 
0 1 1 

0 0 0 
-1 -3 0 
0-2 2 
0 -1 -1 

0 0 0 

1 3 0 
0 2-2 
0 1 1 

0 0 0 
0-3 0 
0 -2 2 
0 -1 -1 
0 0 0 
3 0 
2 -2 
1 1 



dir 1: 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 

dir 1: 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0,757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 



•1 -1 

0 0 



0 
0 

2 3 
1 -2 

1 0 

0 0 

2 -3 

1 2 



0 0 0 
0-3 0 
0 -2 2 
0 -1 -1 
0 0 0 



dir 1: 
dir 4: 
dir 7: 
dir 10: 
dir 13: 
dir 16: 
dir 19: 
dir 22: 



O.500 
0.250 
1.017 
0.757 
0.500 
0.250 
1.017 
0.757 



dir 1: 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 

dir 1: 0.500 
dir 4: 0.25O 
dir. 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 

dir 1: O.50O 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 



-1 -1 0 

0 0 0 
-2 -2 3 
-2 -1 -2 

1 I 0 
0 0 0 
3 2 -3 

2 1 2 

-1 -1 0 

0 0 0 
-2 -3 3 
-2 -2 -2 

1 1 0 
0 0 0 

3 2-3 

2 2 2 

-1 -1 0 

0 0 0 
-2 -3 3 
-1 -2 -2 

1 1 0 

0 0 0 

2 2-3 

1 2 2 

-1 -1 0 

0 0 0 
-2 -3 3 
-1 -2 -2 

1 1 0 

0 0 0 

2 3-3 

1 2 2 

0-10 

0 0 0 

-1 -3 3 

-1 -2 -2 

0 1 0 

0 0 0 

2 3 -3 

1 2 2 



dir 1: 
dir 4: 
dir 7: 
dir 10: 
dir 13: 
dir 16: 
dir 19: 
dir 22: 



0.500 
0.250 
1.017 
0.757 
0.500 
0.250 
1.017 
0.757 



0-10 
0 0 0 
-1 -3 3 
-1 -2 -2 
0 1 0 

0 0 0 
13-3- 

1 2 2 



dir 1: 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 
dir 16: 
dir 19 
dir 22 



0.500 
0.250 
1.017 
0.757 



0 -1 

0 0 

0 -3 

0 -2 
0 1 

0 0 

1 3-3 
0 2 2 



dir 1: 
dir 4: 
dir 7: 
dir 10: 
dir 13: 
dir 16: 
dir 19: 
dir 22: 



0.500 
0.250 
1.017 
0.757 
0.500 
0.250 
1.017 
0.757 



dir 2: 0.75C 

dir 5: 0.50/ 

dir 8: 0.250 

dir 11: 1.017 

dir 14: 0.750 

dir 17: 0.502 

dir 20: 0.250 

dir 23: 1.017 

dir 2: 0.750 
dir 5i 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
dir 20: O.250 
dir 23: 1.017 

dir 2: 0.750 
dir 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
dir 20: 0.250 
dir 23: 1.017 

dir 2: O.750 
dir 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
dir 20: 0.250 
dir 23: 1.017 

dir 2: 0.750 
dir 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
dir 20: 0.250 
dir 23: 1.017 



•1 
0 
•3 
■2 
1 
0 

1 3 -3 
0 2 2 



dir 1: 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 



0-10 
0 0 0 
0-4 3 
0 -2 -2 
0 1 0 



-2 -! 0 

-1 -1 1 

0 0 0 
-3 -2 -3 

2 1 0 

1 1 -1 
0 0 0 

3 2 3 

-2 -1 0 

-1-1 1 

0 0 0 
-3 -2 -3 

2 1 0 

1 1 -1 
0 0 0 

2 2 3 



-2 -2 
-1 -1 
0 0 



-1 -2 
-1 -1 
0 0 



-1 -2 
-1 -1 
0 0 



dir 2: 
dir 5: 
dir 8: 
dir 11: 
dir 14: 
dir 17: 
dir 20: 
dir 23: 

dir 2: 
dir 5: 
dir 8: 
dir 11: 
dir 14: 
dir 17: 
dir 20: 
dir 23: 

dir 2: 
dir 5: 
dir 8: 
dir 11: 
dir H: 
dir 17: 
dir 20: 
dir 23: 

dir 2: 
dir 5: 
dir 8: 
dir 11: 
dir 14: 
dir 17: 
dir 20: 
dir 23: 



0.750 
0.502 
0.250 
1.017 
O.750 
0.502 
0.250 
1.017 

0.750 
0.502 
0.250 
1.017 
0.750 
0.502 
O.2S0 
1.017 

0.750 
0.502 
0.250 
1.017 
0.750 
0.502 
0.250 
1.017 

0.750 
0.502 
0.250 
1.017 
0.750 
0.502 
0.250 
1.017 



dir 2: 0.750 

dir 5: 0.502 

dir 8s 0.250 

dir 11: 1.017 

dir 14: 0.750 



-1 -2 0 
0 -1 1 

0 0 0 
-2 -3 -3 

1 2 0 
0 1 -1 

0 0 0 

1 3 3 

-1 -2 0 
0 -1 1 

0 0 0 
-1 -3 -3 

1 2 0 
0 1 -1 

0 0 0 

1 3 3 

0-2 0 
0 -1 1 
0 0 0 
-1 -3 -3 
0 2 0 
0 1 -1 
0 0 0 
0 3 3 

0-2 0 
0-1 1 
0 0 0 
-1 -3 -3 
0 2 0 
0 1 -1 
0 0 0 
0 3 3 

0-2 0 
0 -1 I 
0 0 0 
0 -3 -3 
0 2 0 
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: 0.250 
t 1.000 
i 0.757 
; 0.502 

1 

! 0.250 
; 1.000 
: 0.757 



dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 

carangle 43 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 

carangle 49 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 50 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: " 
dir 15 
dir 18; 
dir 21 i 
carangle 51 

dir 3 

dir 6i ..... 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 52 
dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 53 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 54 

dir Oi 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21$ 0.502 
carangle 55 

dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.250 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 56 
dir 0: 0.250 
dir 3: 1.000 
dir 6: 0.757 
dir 9: 0.502 
dir 12: 0.25O 
dir 15: 1.000 
dir 18: 0.757 
dir 21: 0.502 
carangle 57 
dir 0: 0.2S0 



0 3 0 
0 2-2 
0 1 1 



0 -1 
0 -4 
0 -3 
0-2 
0 1 
0 4 
0 3 
0 2 



0 0 0 
0-3 0 
0-2 2 
0 -1 -1 
0 0 0 
0 3 0 
0 2-2 
0 1 1 



0 0 0 
0-3 0 
0-2 2 
0-1 -1 
0 0 0 
0 3 0 
0 2-2 
0 1 1 



0 0 

1 -3 
0 -2 
0 -1 
0 

-1 
0 
0 



0 
0 
2 
■1 

0 0 
3 0 
2 -2 

1 1 



0 0 0 

1 -3 0 
1 -2 2 
0 -1 -1 
0 0 0 

-13 0 
-1 Z -2 
0 1 1 

0 0 0 

1 -3 0 
1 -2 2 
0 -1 -1 
0 0 0 

-13 0 
-1 2 -2 
0 1 1 

0 0 0 
2-3 0 

1 -2 2 
1 -1 -1 
0 0 0 

-2 3 0 
-1 2-2 
-1 I 1 

0 0 0 
2-3 0 

1 -2 2 

1 -1 -1 
0 0 0 

-2 3 0 
-1 2 -2 
-1 I 1 

0 0 0 
2-2 0 

2 -2 2 

1 -1 -1 
0 0 0 
►2 2 0 
•2 2 -2 
•1 I 1 



dir 16: 0.250 0 0 0 
djr 19: 1.017 0 3-3 
dir 22: 0,757 0 2 2 



dir 1: 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.25O 
dir 19: 1.017 
dir 22: 0.757 

dir 1: 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 



dir 1: 
dir 4: 
dir 7: 
dir 10: 
dir 13: 
dir 16: 
dir 19: 
dir 22: 



0.500 
0.250 
1.017 
0.757 
0.500 
0.250 
1.017 
0.757 



dir 1: 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 

dir 1: 0.500 

dir 4: 0.250 

dir 7: 1.017 

dir 10: 0.757 

dir 13: 0.500 

dir 16: 0.250 

dir 19: 1.017 

dir 22: 0.757 



0-2 0 
0-10 
0-4 3 
0 -3 -2 
0 2 0 
0 1 0 
0 4-3 
0 3 2 

0-10 
0 0 0 
0-3 3 
0 -2 -2 
0 1 0 
0 0 0 
0 4-3 
0 2 2 

0-10 

0 0 0 

1 -3 3 
0 -2 -2 
0 1 0 
0 0 0 
0 3-3 
0 2 2 

0-10 

0 0 0 

1 -3 3 
0 -2 -2 
0 1 0 
0 0 0 
0 3-3 
0 2 2 



0 -1 

0 0 
3 
2 
I 
0 



3 -3 
2 2 



dir 1: 
dir 4: 
dir 7: 
dir 10: 
dir 13: 
dir 16: 
dir 19: 
dir 22s 



0.500 
0.250 
1.017 
0.757 
0.500 
0.250 
1.017 
0.757 



0-10 

0 0 0 
2-3 3 

1 -2 -2 
0 1 0 

0 0 0 

1 3 -3 
1 2 2 



dir 1: 0.500 

dir 4: 0.250 

dir 7: 1.017 

dir 10: 0.757 

dir 13: 0.500 

dir 16: 0.250 

dir 19: 1.017 

dir 22: 0.757 

dir 1: 0.500 
dir 4: 0.250 
dir 7: 1.017 
dir 10: 0.757 
dir 13: 0.500 
dir 16: 0.250 
dir 19: 1.017 
dir 22: 0.757 



dir 1: 
dir 4: 
dir 7: 
dir 10: 
dir 13: 
dir 16: 
dir 19: 
dir 22: 



0.500 
0.250 
1.017 
0.757 
0.500 
0.250 
1.017 
0.757 



1 -1 0 

0 0 0 

2 -3 3 

1 -2 -2 
-1 1 0 

0 0 0 
-2 3 -3 
-1 2 2 

1 -1 0 

0 0 0 

2 -2 3 

1 -2 -2 
-1 1 0 

0 0 0 
-2 3-3 
-1 2 2 



1 -1 0 

0 0 0 
3-2 3 

2 -2 -2 

1 1 0 
0 0 0 

2 3 -3 
2 2 2 



dir 17: 0.502 0 1 -1 
dir 20: 0.250 0 0 0 
dir 23: 1.017 0 4 3 



dir 2: 0.750 
dir 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
dir 20: 0.250 
dir 23: 1.017 



dir 2: 
dir 5: 
dir 8: 
dir 11: 
dir 14: 
dir 17: 
dir 20: 
dir 23: 

dir 2: 
dir 5: 
dir 8: 
dir 11: 
dir 14: 
dir 17: 
dir 20: 
dir 23: 



0,750 
0.502 
0.250 
1.017 
0.750 
0.502 
0.250 
1.017 

0,750 
0.502 
0.250 
1.017 
0.750 
0.502 
0.250 
1.017 



0-3 0 
0 -2 1 
0-10 
0-4 -3 
0 3 0 
0 2-1 
0 1 0 
0 4 3 

0-2 0 
0-1 1 
0 0 0 
0 -4 -3 
0 2 0 
0 1 -1 
0 0 0 
0 3 3 



0 -2 
0 -1 
0 0 



1 -1 
0 0 
3 3 



dir 2: 0.750 
dir 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
dir 20: 0.250 
dir 23: 1.017 

dir 2: 0.750 
dir 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
dir 20: 0.250 
dir 23: 1.017 



0 -2 
0 -1 



1 -1 
0 0 
3 3 



1 -2 

' -1 
0 
•3 
2 
1 
0 
3 



dir 2: 
dir 5: 
dir 8: 
dir 11: 
dir 14: 
dir 17: 
dir 20: 
dir 23: 



0.750 
0.502 
0.250 
1.017 
0.750 
0.502 
0.250 
1.017 



dir 2: 0.750 
dir 5: 0.502 
dir 8: 0.250 
dir 11: 1.017 
dir 14: 0.750 
dir 17: 0.502 
dir 20: 0.250 
dir 23: 1.017 



dir 2: 
dir 5: 
dir 8: 
dir 11: 
dir 14: 
dir 17: 
dir 20: 
dir 23: 

dir 2: 
dir 5: 
dir 8: 
dir 11: 
dir 14: 
dir 17: 
dir 20: 
dir 23: 



0.750 
0.502 
0.250 
1.017 
0.750 
0.502 
0.250 
1.017 

0.750 
0.502 
0.250 
1.017 
0.750 
0.502 
0.250 
1.017 



1 -2 0 
0-1 1 

0 0 0 

1 -3 -3 
-12 0 

0 1 -1 

0 0 0 
-2 3 3 

1 -2 0 

1 -1 1 
0 0 0 

2 -3 -3 
-12 0 
-1 1 -1 

0 0 0 
-2 3 3 

1 -2 0 

1 -1 1 
0 0 0 

2 -3 -3 
-12 0 
-1 1 -1 

0 0 0 
-2 2 3 

2-2 0 

1 -1 1 
0 0 0 

2 -3 -3 
-2 2 0 
-1 1 -1 

0 0 0 
•3 2 3 



0 0 0 dir 1: 0.500 1 -1 



dir 2: 0.750 2 -1 0 
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dir 3s 1.000 3 -2 0 

dir 6: 0.757 2 -1 2 

dir 9: 0.502 1 -1 -1 

dir 12: 0.250 0 0 0 

dir 15: 1.000 -3 2 0 

dir 18: 0.757 -2 1 -2 

dir 21: 0.502 -1 1 1 

carangle 58 

dir 0: 0.250 0 0 0 

dir 3: 1.000 3 -2 0 

dir 6: 0.757 2 -1 2 

dir 9: 0.502 1 -1 -1 

dir 12: 0.250 0 0 0 

dir 15: 1.000 -3 2 0 

dir 18.- 0.757 -2 1 -2 

dir 21: 0.502 -1 1 1 

caranqle 59 

dir 0: 0.250 0 0 0 

dir 3: 1.000 3 -1 0 

dir 6: 0.757 2 -1 2 

dir 9: 0.502 1 0 -1 

dir 12: 0.250 0 0 0 

dir 15: 1.000 -3 1 0 

dir 18: 0.757 -2 1 -2 

dir 21: 0.502 -1 0 1 

carangle 60 

dir 0: 0.250 0 0 0 

dir 3: 1.000 3 -1 0 

dir 6: 0.757 2 -1 2 

dir 9: 0.502 1 0 -1 

dir 12s 0.250 0 0 0 

dir 15: 1.000 -3 1 0 

dir 18: 0.757 -2 1 -2 

dir 21: 0.502 -1 0 1 

carangle 61 

dir 0: 0.250 0 0 0 

dir 3: 1.000 3 -1 0 

dir 6: 0.757 2 0 2 

dir 9: 0.502 1 0 -1 

dir 12 : 0.250 0 0 0 

dir 15: 1.000 -3 1 0 

dir 18: 0.757 -2 0 -2 

dir 21: 0.502 -1 0 1 

carangle 62 

dir 0 : 0.250 0 0 0 

dir 3: 1.000 3 0 0 

dir 6: 0.757 2 0 2 

dir 9: 0.502 1 0 -1 

dir 12: 0.250 0 0 0 

dir 15: 1.000 -3 0 0 

dir 18: 0.757 -2 0 -2 

dir 21: 0.502 -1 0 1 

carangle 63 

dir 0: 0.250 0 0 0 

dir 3: 1.000 3 0 0 

dir 6: 0.757 2 0 2 

dir 9: 0.502 1 0 -1 

dir 12: 0.250 0 0 0 

dir 15: 1.000 -3 0 0 

dir 18: 0.757 -2 0 -2 

dir 21: 0.502 -1 0 1 



dir 4: 0.250 0 0 0 

dir 7: 1.017 3-2 3 

dir 10: 0.757 2 -i -2 

dir 13: 0.500 -1 1 0 

dir 16: 0.250 0 0 0 

dir 19: 1.017 -2 2 -3 

dir 22:' 0.757 -2 1 2 

dir 1: 0.500 1 -1 0 

dir 4 : 0.250 0 0 0 

dir 7: 1.017 3-2 3 

dir 10 : 0.757 2 -1 -2 

dir 13: 0.500 -1 1 0 

dir 16: 0.250 0 0 0 

dir 19: 1.017 -3 2 -3 

dir 22: 0.757 -2 1 2 

dir 1: 0.500 1 0 0 

dir 4: 0.250 0 0 0 

dir 7: 1.017 3 -1 3 

dir 10: 0.757 2 -1 -2 

dir 13: 0.500 -10 0 

dir 16: 0.250 0 0 0 

dir 19: 1.017 -3 2 -3 

dir 22: 0.757 -2 1 2 

dir 1: 0.500 1 0 0 

dir 4: 0.250 0 0 0 

dir 7: 1.017 3-13 

dir 10: 0.757 2 -1 -2 

dir 13: 0.500 -10 0 

dir 16: 0.250 0 0 0 

dir 19: 1.017 -3 1 -3 

dir 22: 0.757 -2 1 2 

dir 1: 0.500 1 0 0 

dir 4: 0.250 0 0 0 

dir 7: 1.017 3 0 3 

dir 10: 0.757 2 0 -2 

dir 13: 0.500 -10 0 

dir 16 : 0.250 0 0 0 

dir 19: 1.017 -3 1 -3 

dir 22: 0.757 -2 0 2 

dir 1: 0.500 1 0 0 

dir 4 : 0.250 0 0 0 

dir 7: 1.017 3 0 3 

dir 10: 0.757 2 0 -2 

dir 13: 0.500 -10 0 

dir 16: 0.250 0 0 0 

dir 19: 1.017 -3 1 -3 

dir 22: 0.757 -2 0 2 

dir 1: 0,500 1 0 0 

dir 4: 0.250 0 0 0 

dir 7: 1.017 4 0 3 

dir 10 : 0.757 2 0 -2 

dir 13: 0.500 -10 0 

dir 16: 0.250 0 0 0 

dir 19: 1.017 -3 0 -3 

dir 22: 0.757 -2 0 2 



dir 5: 0.502 1 - 1 1 

dir 8: 0.250 0 0 0 

dir 11: 1.017 2 -2 -3 

dir 14: 0.750 -2 1 0 

dir 17: 0.502 -1 1 -1 

dir 20: 0.250 0 0 0 

\iir 23: 1.017 -3 2 3 

dir 2: 0.750 2 -1 0 

dir 5: 0.502 1 -1 1 

dir 8: 0.250 0 0 0 

dir It: 1.017 3 -2 -3 

dir 14: 0.750 -2 1 0 

dir 17: 0.502 -1 1 -1 

dir 20: 0.250 0 0 0 

dir 23: 1.017 -3 2 3 

dir 2: 0.750 2-10 

dir 5 : 0.502 1 0 1 

dir 8: 0.25O 0 0 0 

dir 11: 1.017 3 -2 -3 

dir 14: 0.750 -2 1 0 

dir 17: 0.502 -1 0 -1 

dir 20 : 0.250 0 0 0 

dir 23: 1.017 -3 1 3 

dir 2: 0.75O 2-10 

vdir 5 : 0.502 1 0 1 

dir 8: 0.250 0 0 0 

dir 11: 1.017 3 -1 -3 

dir 14: 0.75O -2 1 0 

dir 17: 0.502 -1 0 -1 

dir 20 : 0.250 0 0 0 

. dir 23: 1.017 -3 1 3 

dir 2: 0.750 2 0 0 

dir 5: 0.502 1 0 1 

dir 8: 0.250 0 0 0 

dir 11: 1.017 3 -1 -3 

dir 14: 0.750 -2 0 0 

dir 17: 0.502 -1 0 -1 

dir 20: 0.250 0 0 0 

'dir 23: 1.017 -3 0 3 

dir 2: 0.75O 2 0 0 

dir 5: 0.502 1 0 1 

dir 8 : 0.250 0 0 0 

dir 11: 1.017 3 -1 -3 

dir 14: 0.750 -2 0 0 

dir 17: 0.502 -1 0 -1 

dir 20: 0.250 0 0 0 

dir 23: 1.017 -3 0 3 

dir 2: 0.750 2 0 0 

dir 5: 0.502 1 0 1 

dir 8 : 0.250 0 0 0 

dir 11: 1.017 3 0 -3 

dir 14: 0.750 -2 0 0 

dir 17: 0.502 -1 0 -1 

dir 20: 0.250 0 0 0 

dir 23: 1.017 -4 0 3 
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Claims 

• 55 1. Apparatus for planning a path for a vehicle to follow through a given task space from a start point to a 
goal point, the path satisfying a given cost criterion, the vehicle being movable on at least one wheel and a 
rotatable or gliding support, said wheel being positioned substantially at one end of the vehicle and being 
steerable, said support being positioned substantially at the other end of the vehicle, characterized in that 

21 
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the apparatus comprises means for storing an internal representation of a close environment of the vehicle, 
means for representing a pose of the vehicle in the given task space, which pose is measured in respect of 
a fixed point of the vehicle, and means for calculating a maneuver trajectory based on the internal 
representation. 

5 2. Apparatus according to Claim 1 t characterized in that the fixed point is positioned at a point of 
symmetry with respect to the support. 

3. Apparatus according to Claim 1 or 2, characterized in that the storing means comprises a memory 
for storing a representation of a discretized configuration space corresponding to a discretized subset of all 
positions of the vehicle in the given task space, wherein the representation at the configuration space 

io includes an array of states, each state having cost to goal and direction arrow fields, wherein the array 
includes a first and a second dimension for representing the pose of the vehicle in the given task space 
along a first and along a second Cartesian axis, respectively; and a third dimension for representing the 
pose of the vehicle according to an angular orientation of the vehicle, and in that the calculating means 
comprises means for propagating cost waves in the configuration space, and means for determining a path 

75 from a start state to a goal state in the configuration space based on the cost waves. 

4. Apparatus according to Claim 3, characterized in that the propagating means includes computing 
means for repeatedly 

a) exploring all neighbour states of a state in the configuration space; 

b) improving neighbour states of the state by assigning appropriate values of cost to goal and direction 
20 arrows to the state; 

c) adding improved neighbour states to a storage data structure; 
the steps a), b), c) hereinafter being referred to as budding a state. 

5. Apparatus according to Claim 4, characterized in that budding a state includes searching states 
according to a precedence in which if a first neighbour state is blocked by an obstacle, no second 

25 neighbour state beyond the first neighbour state is searched. 

6. Apparatus according to Claim 5 f characterized in that a representation of neighbour states is stored in 
a neighbour memory in a tree structure according to said precedence, wherein subtrees of neighbour states 
which are blocked are neglected during the search. 

7. Apparatus according to Claim 3, characterized in that the determining means includes computing 
30 means for following values in the direction arrow fields. 

8. Apparatus according to any one of Claims 3, 4, 5. 6 and 7, characterized in that the vehicle is a car, 
the pose of which is measured along the first and second Cartesian axes according to a position of the rear 
differential of the car. 

9. Apparatus according to any one of Claims 3, 4, 5, 6, 7 and 8 f characterized in that each state in the 
35 representation of the configuration space has a set of neighbour states which fall within a bow-tie shape in 

task space. 

10. Apparatus according to any one of the previous Claims, characterized in that the vehicle is a car 
and the maneuver trajectory is a path for parallel parking between two parked cars. 

11. Apparatus according to Claim 10, characterized in that the path is a path for making a three point 
40 turn. 

12. Vehicle comprising an apparatus according to any one of the previous Claims. 

13. A method for planning a path for an object to follow in a task space comprising the step of 
propagating cost waves in a configuration space representation of the task space, which propagating step 
comprsies the step of budding in a neighbourhood of at least one state in the configuration space using a 

45 precedence in which if a first neighbour state is blocked by an obstacle, no second neighbour state beyond 
the first neighbour state is searched. 

14. A method for planning a path for an object to follow in task space comprising the step of 
propagating cost waves in a configuration space representation of the task space, which propagating step 
comprises the step of budding in space variant neighbourhoods of at least two states. 

so 15. Method according to Claim 14 characterized in that a shape of the neighbourhoods varies by state 
of configuration space. 

16. Method according to Claim 14, characterized in that neighbours correspond to respective numbers 
of transitions along respective parameter axes of configuration space and the respective numbers vary by 
state of the configuration space. 
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© Method and apparatus for controlling maneuvers of a vehicle, and vehicle comprising such 
apparatus. 



© Maneuvers of a vehicle, such as a car, are 
planned by • propagating cost waves in a configura- 
tion space using a search strategy referred to as 
budding. 

The apparatus comprises means for storing an 
internal representation of a close environment of the 
vehicle, means for representing a pose of the vehicel 
in the given task space, which pose is measured in 
respect of a fixed point of the vehicle, and means for 
calculating a maneuver trajectory based on the inter- 
nal representation. The close environment is a terri- 
tory in which the maneuvering is performed: its size 
is within approximately the same order of magnitude 
as the size of the vehicle. 
If) The method of differential budding involves iden- 
tifying a region in configuration space which is af- 
fected by a change of conditions in task space. 
IT> Precisely selected states referred to as a perimeter 



CO 



CO 



and which define this region are then placed on a 
"sifting heap" from which they are budded. 



LU 
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